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This  thesis  examines  the  use  of  a  single,  omnidirectional  hydrophone  as  a 
receiving  sensor  to  passively  localize  an  acoustic  beacon.    The  localization  problem  is 
presented  as  a  constrained,  nonlinear  parameter  estimation  problem,  and  Lagrange 
multipliers  are  introduced  to  solve  for  the  maximum  likelihood  estimate  of  the  acoustic 
beacon's  position.    An  iterative  algorithm  is  developed  using  range  difference 
measurements  to  solve  for  the  maximum  likelihood  estimate  of  a  stationary  acoustic 
beacon's  position.    This  algorithm  is  then  extended  to  include  linear,  constant  velocity 
motion  of  the  acoustic  beacon.    Finally,  design  specifications  for  a  receiver  to 
implement  the  maximum  likelihood  estimation  algorithms  are  developed. 

To  test  the  maximum  likelihood  estimate  algorithms,  Monte  Carlo  simulations 
are  conducted.    Results  from  six  representative  scenarios  are  presented.    Test  results 
show  that  as  the  number  of  range  differences  used  increases,  or  the  distance  that  the 
observer  travels  between  received  beacon  signals  increases,  the  accuracy  of  the 
estimated  position  improves.    Also,  tests  show  that  accuracy  of  the  estimated  beacon 
position  is  directly  related  to  the  accuracy  in  which  the  observer's  position  is 
measured.    To  test  the  receiver's  design  specifications,  a  prototype  receiver  is  built 
using  commonly  available  components.    It  is  then  shown  that  the  prototype  receiver 
meets  or  exceeds  the  design  specifications. 
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Chapter  I 
Introduction  and  Problem  Statement 


1.1    Introduction 


There  are  many  scenarios  in  which  passive  localization  of  an  acoustic  beacon  is 
needed.    Techniques  like  Target  Motion  Analysis  and  Bearings  Only  Ranging  can 
passively  estimate  an  acoustic  beacon's  position  by  using  received  bearing  information. 
These  techniques  rely  upon  a  multiple  sensor  receiving  array  to  find  the  relative 
bearing  between  the  acoustic  beacon  and  the  observer.    To  estimate  the  position  of  the 


Figure  1-1 


acoustic  beacon,  bearing  lines  from  several  different  observation  points  are  combined 
to  form  a  fix.    See  figure  1-1. 

Recent  developments  in  passive  target  ranging  and  tracking  which  use  arrays  of 
only  a  few  elements  can  also  be  used  to  passively  localize  an  acoustic  beacon  [Allen 
and  King  1988]  [Friedlander  1987]  [Moose  1987].    These  methods  rely  upon  the  array 
to  estimate  the  relative  bearing  between  the  acoustic  beacon  and  the  observer  as  well. 
Statistical  and  test  analyses  have  shown  that  the  performance  of  the  localization 
techniques  mentioned  above  improves  with  increased  distance  between  sensor  elements 
in  the  receiving  array  [Moose  1987].    This  typically  leads  to  the  use  of  long  receiving 
arrays.    The  use  of  long  arrays  can  become  a  problem  if  the  ship  used  to  deploy  the 
array  is  small,  or  if  budget  constraints  limit  the  size  of  the  array.    For  these  cases,  the 
observer  can  employ  a  technique  that  uses  a  single  omnidirectional  sensor  to  form  a 
synthetic  aperture  array  instead  of  a  conventional  receiving  array  to  passively  localize 
the  acoustic  beacon. 

Previous  techniques  to  localize  acoustic  beacons  using  a  single  omnidirectional 
hydrophone  instead  of  an  array  use  a  raster  scanning  paper  recording  device  to 
produce  a  mark  on  recording  paper  whenever  a  beacon  signal  is  received.    The  scan 
rate  of  the  paper  recorder  is  matched  to  the  pulse  repetition  interval  of  the  acoustic 
beacon.    This  synchronizes  the  paper  recorder,  so  that  a  new  line  is  printed  for  each 
pulse  repetition  interval.   The  observer  can  note  the  relative  change  in  travel  time 
between  successive  beacon  signals  by  comparing  the  locations  of  the  corresponding 
marks  on  the  recording  paper.    If  the  observer  and  the  acoustic  beacon  are  stationary, 
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Synchronized   Time   of   Receipt 


CPA   2 


CPA    1 


CPA    1 


Figure  1-2 

the  time  it  takes  the  acoustic  beacon's  signal  to  travel  between  the  beacon  and  the 
observer  is  constant.    For  this  case,  the  trace  made  by  the  paper  recorder  is  a  vertical 
line.    As  the  observer  approaches  the  beacon  along  a  linear  path,  the  range  to  the 
beacon,  and  consequently  the  time  that  the  beacon  signal  takes  to  travel  to  the 


observer,  decreases  hyperbolically.    The  corresponding  trace  made  by  the  paper 
recorder  is  also  hyperbolic.    The  observer  can  use  this  relation  to  fix  the  acoustic 
beacon's  position.   To  obtain  a  line  of  bearing  to  the  acoustic  beacon,  the  observer 
watches  for  the  closet  point  of  approach  (CPA)  to  the  acoustic  beacon  by  noting  the 
point  where  the  trace  produced  by  the  paper  recorder  changes  from  negative  to 
positive  slope.    This  corresponds  to  the  transverse  axis  of  the  hyperbolic  trace  and  is 
the  point  where  the  range  changes  from  decreasing  to  increasing.    At  the  CPA,  the 
acoustic  beacon  is  located  on  a  line  of  bearing  perpendicular  to  the  direction  of  the 
observer's  motion.    To  estimate  the  location  of  the  acoustic  beacon,  the  observer  must 
obtain  lines  of  bearing  from  at  least  two  different  directions  of  motion.    See  figure  1-2. 
This  method  of  passively  locating  acoustic  beacons  relies  heavily  upon  the  operator's 
skill  in  visually  identifying  the  closest  point  of  approach  from  the  printed  output  of  the 
paper  recorder.    Also,  the  observer  is  forced  to  travel  in  a  straight  line  for  a  significant 
period  of  time  until  the  CPA  can  be  determined.    Other  factors  that  limit  the 
usefulness  of  the  above  method  are  that  paper  recorders  tend  to  be  bulky,  awkward  to 
move,  and   require  an  adequate  supply  of  expensive  recording  paper. 

This  thesis  examines  the  use  of  a  single  omnidirectional  hydrophone  in  place  of 
a  conventional  receiving  array  to  efficiently  localize  an  acoustic  beacon  using  a 
nonlinear  parameter  estimation  technique.    The  goal  is  to  develop  an  inexpensive, 
easily  deployed  localization  receiver  that  can  interface  to  a  personal  computer  for  data 
analysis  and  signal  processing.    As  a  backup,  this  receiver  must  also  perform  the 
functions  of  the  older  paper  recording  system,  using  the   personal  computer  as  the 
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display  device. 
1.2    Organization 

This  thesis  is   organized  into  six  chapters  and  three  appendices: 

•  Chapter  I  contains  an  introduction  to  the  problem  of  passively  localizing 
acoustic  beacons. 

•  Chapter  II  contains  the  development  of  a  technique  to  localize  a  stationary 
acoustic  beacon  using  a  constrained  Maximum  Likelihood  Estimator  (MLE). 

•  Chapter  III  contains  an  extension  of  the  solution  to  the  stationary  acoustic 
beacon  localization  problem  that  allows  for  constant  velocity,  linear  motion  of 
the  acoustic  beacon. 

•  Chapter  IV  contains  results  of  Monte  Carlo  simulations  of  the  localization 
algorithms  developed  in  chapters  II  and  III.    The  effects  of  using  different 
effective  sensor  spacings  and  different  numbers  of  experimental  data  points  are 
explored. 

•  Chapter  V  contains  design  criteria  for  a  receiver  to  implement  the  algorithms 
developed  in  chapters  II  and  III.    A  test  receiver  is  designed  and  built  based 
upon  these  criteria,  and  experiments  are  conducted  to  measure  the  actual 
performance  of  the  receiver. 

•  Chapter  VI  contains  observations  and  concluding  remarks. 

•  Appendix  1  contains  the  schematic  diagrams  of  the  receiver  designed  in 
chapter  V. 

•  Appendix  2  lists  the  source  code  for  the  68HC11  microcontroller  used  in  the 
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receiver  designed  in  chapter  V. 

Appendix  3  lists  the  source  code  for  the  Macintosh  computer  used  for  data 

analysis  and  signal  processing. 
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Chapter  II 
Stationary  Acoustic  Beacon 
2.1    Introduction 

When  the  acoustic  beacon  is  stationary,  we  are  interested  in  locating  the 
acoustic  beacon  to  within  a  certain  error  bound  as  efficiently  as  possible.    To 
accomplish  this  we  treat  the  acoustic  beacon's  location  as  an  unknown  parameter 
vector,  and  formulate  the  localization  problem  as  a  constrained  multiple  dimension 
parameter  estimation  problem.    To  solve  the  constrained  parameter  estimation  problem, 
we  first  develop  a  structural  model  that  relates  the  values  of  a  set  of  available 
measurements  to  the  unknown  parameter  vector.    We  then  define  a  residual  error 
vector  as  the  difference  between  the  true  values  and  the  actual  values  of  the 
measurements.    Assuming  the  measurement  errors  are  normally  distributed, 
independent  random  variables,  we  define  the  likelihood  function  for  a  particular  set  of 
measurements  as  the  logarithm  of  the  joint  probability  density  function  of  the 
measurements  errors,  viewed  as  a  function  of  the  residual  error  vectors.    Next,  we 
form  a  set  of  equality  constraints  by  evaluating  the  structural  model  at  the  true  values 
of  the  measurements,  and  the  true  value  of  the  parameter  vector  6.   To  find  the 
maximum  likelihood  estimate  {MLE)  of  the  unknown  parameter  vector,  we  introduce  a 
vector  of  Lagrange  multipliers,  and  then  define  a  Lagrangian  function  as  the 
combination  of  the  likelihood  function  and  the  sum  of  the  equality  constraints, 
weighted  by  the  Lagrange  multipliers.    The  maximum  likelihood  estimate  is  then 
found  by  determining  the  stationary  point  of  the  Lagrangian  function. 
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2.2    Problem  Geometry 

Consider  the  acoustic  beacon  to  be  at  a  fixed  latitude,  longitude,  and  depth. 
Since  we  are  only  concerned  with  locating  the  acoustic  beacon  in  a  small  region  of  the 
ocean,  we  approximate  the  earth  as  being  flat  in  the  region  around  the  beacon's 
position  and  use  a  Cartesian  coordinate  system  to  describe  the  location  of  the  acoustic 
beacon.    The  use  of  a  Cartesian  coordinate  system  does  not  contribute  any  significant 
errors  as  long  as  we  correct  for  distortions  due  to  the  projection  of  the  acoustic 
beacon's  global  coordinates  onto  the  local  Cartesian  coordinate  system.    We  define  a 
parameter  vector  0  as: 


o  ■  ■  L  "*t    jt    ^t  J 


(2-1) 


where  xT  represents  the  east-west  position  of  the  acoustic  beacon,  yT  represents  the 
north-south  position  of  the  acoustic  beacon,  and  Zj-  represents  the  depth  of  the  acoustic 
beacon  in  meters  relative  to  the  center  of  the  local  Cartesian  coordinate  system.    To 
correct  for  the  distortions  caused  by  projecting  the  acoustic  beacon's  global  coordinates 
onto  the  local  Cartesian  coordinate  system,  we  introduce  a  correction  factor  that  is 
proportional  to  the  cosine  of  the  latitude.    We  then  relate  9  to  the  acoustic  beacon's 
global  position  by: 


e  = 


yT 


60  Nm    1853.2  m         .,  ,  ..„  , ,    „ 

degrees  longitude  • : —  •  —  -cos(degrees  latitude) -xR 


V 


1  Nm 


a  i^j     60  Nm    1853.2  m 

degrees  latitude  * ■ -  y » 

s  \o  \  Nm         * 

-  depth 


(2-2) 
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where  xR  and   yR  define  an  arbitrary  reference  point  on  the  surface  of  the  ocean  which 
defines  the  origin  of  the  local  Cartesian  coordinate  system.    In  equation  (2-2)  we 
assume  that  the  acoustic  beacon's  latitude  and  longitude  are  given  in  degrees. 

Similarly,  we  consider  an  observer  on  a  receiving  ship  in  the  general  location 


of  the  acoustic  beacon.    We  define  a  measurement  vector  mM  as: 


%  =  l*v  y^   ^  ]] 


(2-3) 


where  xM  and  yM  are  the  receiving  ship's  coordinates  on  the  same  local  Cartesian 
coordinate  system  defined  for  the  acoustic  beacon,  and  tH  is  the  time  that  the  observer's 
position  x      yM  was  obtained.    We  use  the  same  relation  described  in  equation  (2-2)  to 
convert  the  receiving  ship's  global  coordinates  to  local  Cartesian  coordinates.    The 
measurement  vector  mM  is  then  given  by: 


%  = 


degrees  longitude 


60  Nm    1853.2w 


V 


1  Nm 


cos  (degrees  latitude)  -  x. 


a           i^j     60  Nm    1853.2  m 
degrees  latitude  • —  •    ;     —  -  yR 


V 


1  Nm 


(2-4) 

Again,  we  assume  that  the  receiving  ship's  latitude  and  longitude  are  given  in  degrees. 
Figure  2-1  summarizes  the  problem  geometry. 

Now  let  us  assume  that  the  acoustic  beacon  transmits  a  signal  at  a  regular 
interval,  and  that  at  time  tM  the  observer  receives  one  of  the  signals  from  the  acoustic 
beacon.    The  time  tM  can  be  related  to  the  time  that  the  signal  took  to  reach  the 
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(x2.y2.0) 


Figure  2-1 

observer  by: 


Acoustic   Beacon 


t=Tm  +  i'Tm  +  Ta 

\l  Ac  p  O 


(2-5) 


Here  TR  represents  the  acoustic  travel  time  of  the  signal,   T0  is  the  time  that  the 
acoustic  beacon  transmitted  the  first  signal,  /  is  the  number  of  pulse  repetition  intervals 
between  when  the  first  signal  was  transmitted  and  when  the  current  signal  was 
transmitted,  and  Tp  represents  the  pulse  repetition  interval.    The  product  /'Tp  represents 
the  time  after  T.  that  the  acoustic  beacon  transmitted  the  current  received  signal.    It  is 
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assumed  that  the  observer  knows  the  pulse  repetition  interval  of  the  acoustic  beacon. 
The  observer  can  therefore  remove  the  dependance  upon  /'Tp  by  counting  the  number 
of  signals  received  (/'),  then  subtracting  /Tp  from  equation  (2-5).    This  synchronizes 
the  observer's  receiver  with  the  pulse  repetition  interval  of  the  acoustic  beacon.    We 
define  the  synchronized  time  of  receipt  as  the  time  of  receipt  tH  corrected  to  eliminate 
the  pulse  repetition  interval  of  the  acoustic  beacon  as: 

t      =  t    -iT    =  TD  +  T  (2-6) 

and  subsequently  redefine  the  measurement  vector  mM  as: 

«,  =  [  h    *    <*  J""  (2"?) 

The  difficulty  in  passively  ranging  an  acoustic  beacon  arises  because  the 
observer  does  not  know  T0,  the  time  the  acoustic  beacon  started  to  transmit.    In  active 
ranging  systems,  the  observer  can  measure  TR  directly  by  transmitting  a  signal  at  a 
known  time  T0,  and  measuring  the  time  that  the  corresponding  reflected  signal  from  a 
target  is  received.    In  passive  ranging  systems,  the  observer  does  not  know  when  the 
beacon  signal  was  transmitted  and  therefore  the  observer  has  no  time  reference  T0. 
Consequently  the  observer  has  no  way  to  directly  calculate  TR.    In  order  to  passively 
range  a  target,  the  observer  must  eliminate  the  dependence  on  the  absolute  time 
reference  T0. 
2.3    Structural  Model 

In  order  to  proceed,  we  must  develop  a  model  which  relates  the  measurement 
vector  mM,  and  the  unknown  parameter  vector  0.     We  define  a  function  ^m^,  8) 
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which  relates  the  distance  between  the  acoustic  beacon's  position  0  and  the  receiving 
ship's  position    xM,   yM  to  the  synchronized  time  of  receipt  tSM  as: 

/(%,  0)  s  }l(^'XTf*(yvL-yTf*zi  ~  x(C,  tSil)  (2"8> 

where  x(C,  tSfl)  is  a  function  that  relates  the  speed  of  sound  in  seawater  to  the 
measured  time  of  receipt,  synchronized  to  the  pulse  repetition  interval  of  the  acoustic 
beacon.    It  is  assumed  that  the  receiving  ship  is  on  the  surface  of  the  ocean,  or 
equivalently  zp  is  zero.    Using  a  homogeneous  ocean  model  and  a  direct  path 
propagation  mode  for  simplicity,  we  can  define  x(C,  tSfl)  from  equation  (2-6)  as: 

tCC,^)  =CTR  =  CtsyL-CT0  (2-9) 

Substituting  equation  (2-9)  into  equation  (2-8)  yields: 

/(»,,  6)  =  Jix^-XTfHyt-yTf+zi-iC't^-C'T.)        (2-10> 

It  is  apparent  from  equation  (2-10)  that  we  can  not  eliminate  the  dependence 
upon  T0  with  only  one  received  signal  from  the  acoustic  beacon.    One  way  around  this 
problem  is  to  compare  the  time  of  receipt  and  positions  from  two  separate  received 
signals.    This  is  commonly  referred  to  as  range  difference,  or  time  difference  ranging. 
We  define  a  new  function  g(m„  m2,  0)  as: 

g(ml9  m2t  0)  =/(«!,  0)  -/(w2,  0)  (Ml) 

Substituting  equation  (2-10)  into  equation  (2-11)  with  m,  for  the  first  received  signal 
and  m2  for  the  second  received  signal  we  have: 
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g(mv  ro2,  0)  =  ^{x^Xj-f^iy^-yjf^zl  +... 
-^(x2-xTf  +  (y2-yTf  +  ZT  +••• 

The  first  two  terms  of  the  function  g(m,,  m2,  0)  represent  the  slant  range  between  the 
acoustic  beacon  and  the  receiving  ship  at  the  two  separate  times  that  a  beacon  signal  is 
received.    By  subtracting  one  range  from  the  other,  we  are  left  with  the  distance  that 
the  observer  moved  radially,  relative  to  the  beacon,  between  the  times  tsl  and  ts2.  This 
is  known  as  the  range  difference  between  the  two  points  given  by  m,  and  m2.    The  last 
term  of  the  function  g(m,,  m2,  0)  represent  the  range  difference  between  points   m, 
and  m2  calculated  from  the  time  difference.    From  the  last  term  of  g(m„  m2,  0)  we  see 
that  the  dependence  upon  T0  is  eliminated,  and  we  are  left  with  a  model  that  relies  on 
measuring   the  time  of  receipt,  synchronized  to  the  pulse  repetition  interval  of  the 
acoustic  beacon,  and  the  location  of  the  receiving  ship  at  the  time  of  receipt. 

To  simplify  notation,  we  define  an  experiment  to  be  the  augmentation  of  two 
measurement  vectors  m,  and  m2,  and  use  the  notation: 


*v  ■ 


ml 


m2 


=  [*i    *    tsl    x2   y2    ta2]7 


(2-13) 


We  then  redefine  the  equation  (2-12)  as  a  scaler  valued  function  of  the  experiment 
vector   wM  and  the  acoustic  beacon  location  vector  0: 


*0V6)  =g(m19  m2,  0)  (2-14) 
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We  denote  the  function  g(wM,  9)  as  the  structural  model  of  the  parameter  estimation 

problem.    Ideally,  if  the  measurements  have  no  errors  and  x(C,  tJfi)  is  the  correct 

propagation  model,   g(wM,  0)  equals  zero  at  the  true  value  of  the  parameter  vector  9. 

The  estimation  problem  is  then  to  determine  the  value  of  the  parameter  vector  9  that 

minimizes  the  value  of  the  structural  model  given  experiment  vectors  which  contain 

errors. 

2.4    Measurement  Errors 

The  structural  model  describes  the  ideal  situation  -  perfect  measurements,  free 
from  any  errors.  In  reality  both  the  synchronized  time  of  receipt  tSM  and  the  positions 
x  ,  yM  have  errors  associated  with  the  measurement  process.  We  can  define  the  actual 
measurements  as  the  sum  of  the  true  value  and  a  random  error  component: 


*,+*, 

>Wi 

£l+£l 

w„  = 

W,.  +  w„  = 

^ 

V       n 

x2  +  x2 
iS2  +  L 

(2-15) 


where  xM,  yp,   tSM,  and  wp  represent  the  true  values  of  the  measurements,  and  xM,  yM, 
fgJ1,  and  wM  represent  the  random  errors  associated  with  the  measurement  process. 

With  the  assumption  of  a  homogeneous,  direct  path  propagation  mode,  and 
since  the  time  of  receipt  will  be  determined  by  looking  at  the  output  of  a  simple 
digital  peak  detector,  the  errors  in  measuring   tSM  arise  mainly  from  the  sampling  of  the 
received  signal.    Because  we  use  a  simple  peak  detector  to  measure  the  time  of 
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receipt,  we  can  only  estimate  the  true  time  of  receipt  to  within  one  sampling  interval  - 
if  we  sample  the  received  signal  every  millisecond,  then  we  can  only  know  the  time  of 
receipt  to  within  1  millisecond.    This  quantization  of  the  time  base  causes  the 
measurement  errors  to  have  a  uniform  distribution  centered  around  the  true  value   L, 
with  a  variance  given  by: 

a2   =  l£-  (2-16) 

'"     12 

where  Ts  is  the  sampling  interval  in  seconds.    For  the  sake  of  computational  efficiency 
and  mathematical  tractability,  we  would  like  to  model  the  measurement  errors  of  tsp  as 
zero  mean,  normally  distributed  random  variables.    If  we  consider  that  the  structural 
model  is  not  exact  (a  far  more  complex  function  x(C,  tSfl)  is  needed  to  have  an  exact 
structural  model),  and  that  there  will  be  errors  due  to  factors  such  as  dispersion  and 
multipath  interference,  we  can  lump  the  modeling  errors  of  x(C,  tSfi)  together  with  the 
quantization  errors  in  the  time  tSM.    Although  not  strictly  rigorous,  this  allows  us  to 
simplify  the  development  of  the  solution  to  the  localization  problem  by  assuming  the 
measurement  errors  of  tSM  are  zero  mean,  normally  distributed  random  variables,  with  a 
variance  approximated  by  atM2.    Also,  since  the  measurement  of  the  time  of  receipt  of 
one  signal  is  not  effected  by  the  measurement  of  any  other  time  of  receipt,  we  can 
take  the  errors  in  measuring  tSM  as  independent  between  tsl  and  ts2,  and  also 
independent  between  experiments  wM. 

Errors  in  measuring  the  ship's  position  at  the  time  of  receipt  of  the  beacon 
signal  are  due  to  the  accuracy  of  the  system  used  to  obtain  the  ship's  position.    To 
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obtain  the  ship's  location,  a  Global  Positioning  System  (GPS)  receiver  will  be  used. 
Other  navigation  systems  such  as  Loran,  Omega,  or  even  Inertial  Navigation  systems 
could  be  used,  however  the  price  and  accuracy  of  the  GPS  system  make  it  the  natural 
choice.    Currently,  inexpensive  commercial  C/A  code  GPS  receivers  are  available  with 
published  errors  on  the  order  of  25  meters  rms  in  latitude  and  longitude.    The  more 
accurate  Differential  GPS  and  P  code  receivers  are  not  readily  available  at  this  time. 
We  will  assume  that  the  errors  of  the  GPS  positional  data  are  normally  distributed,  and 
independent  in  latitude  and  longitude.     This  assumption  is  unlikely  to  cause  much 
harm  as  long  as  the  true  probability  distribution  of  the  errors  have  smooth  tails  [Bard 
1974]. 

With  these  arguments  in  mind,  and  for  the  sake  of  computational  efficiency  and 
mathematical  tractability,  we  model  the  measurement  errors  as  zero  mean,  normally 
distributed,  independent  random  variables.    We  take  the  covariance  matrix  of  the 
measurement  errors  as: 


\- 


0       0       0       0        0 


0      o  2     0       0       0        0 


0        0     o2     0       0  0 

n 

0        0       0  o  2     0  0 

0        0       0       0  o  2  0 


0        0       0       0       0a, 


(2-17) 


Where  a,M2  is  the  variance  given  by  equation  (2-16),  ox2  is  the  variance  of  the  GPS 
longitude  error  in  meters,  and  a  2  is  the  variance  of  the  GPS  latitude  error  in  meters. 
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2.5    Parameter  Estimation  Solution  -  Maximum  Likelihood  Estimator 

To  solve  for  the  parameter  vector  0  we  would   normally  use  a  weighted  least 
square  approach.    However,  because  of  the  nonlinearities  in  the  structural  model 
g(wM,  0),  and  because  all  of  the  measurements  have  errors,  the  weighted  least  squares 
method  does  not  work  well.    To  demonstrate  why  the  normal  weighted  least  squares 
method  does  not  work  well,  we  look  at  the  contours  of  the  x2  merit  function: 


i=l 


(g(w*,Q))2 


\ 


(2-18) 


If  the  structural  model  is  truly  exact,  and  there  are  no  measurement  errors  in  wM, 
g(w(1,  0)  and  x2  are  equal  to  zero  for  the  true  value  of  0.    As  the  value  of  0  in 
equation  (2-18)  moves  farther  away  from  the  true  value  of  0,  the   %2  function 
increases.    Figure  2-2  shows  the  contours  of  the  x2  function  for  the  true  values  of  the 
measurements  wM,  where  the  acoustic  beacon  is  located  at   xT  =  -1000,  yT  =  1000,  and 
Zj  =  -1000.    From  Figure  2-2  we  see  that  the  contours  of  the  x2  merit  function  that 
encircle  the  true  position  of  the  acoustic  beacon  are  highly  eccentric.    This  eccentricity 
leads  to  large  variances  in  the  location  estimate  along  the  major  axis  of  the  ellipse. 
With  errors  in  all  of  the  measurements,  this  in  turn  produces  errors  in  the  parameter 
estimates  that  are  unacceptable. 

To  overcome  the  difficulties  in  solving  the  parameter  estimation  problem  with  a 
nonlinear  structural  model  and  errors  in  all  of  the  measurements,  we  treat  the  problem 
as  a  constrained  minimization  problem.    Our  goal  is  to  estimate  the  true  values  of  the 
measurements  wM  given  a  set  of  n  equality  constraints  which  we  obtain  by  setting  the 
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Figure  2-2    Chi  Square  Contours  for  the  Normal  Weighted  Least  Squares  Method 

structural  model  g(wM,  0)  equal  to  zero  at  the  estimated  true  values  of  the 
measurements  and  the  estimated  parameter  vector  0.    Because  of  the  measurement 
errors,  we  must  modify  the  structural  model  to  indicate  the  dependence  upon  the  true 
values  of  w„: 


-)J(x2-xT)2  +  (y2-yT)2  +  ZT  +••• 
-C'(tsl-ts2) 
Next  we  define  a  residual  vector  as  the  difference  between  the  true  value  and  the 
observed  value  of  the  measurements: 


(2-19) 
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w  V%  (2'20) 

We  also  define  a  composite  experiment  vector  W  as  the  augmentation  of  n  experiment 
vectors  wM: 


W  = 


T  IT 


Wi       W2  (2_21) 


With  the  assumption  that  the  measurement  errors  are  normally  distributed 
random  variables,  independently  distributed  between  experiments,  and  with  the  further 
assumption  that  the  covariance  matrix  is  the  same  for  each  experiment,  the  likelihood 
function  takes  the  form: 

k)g(L(W,  V))  =  -(n/2)log(detK)-±-£  e?  V1  e  (2"22) 

where  n  is  the  number  of  experiment  vectors  wM  used  in  the  estimation  problem  [Bard 
1974].    The  maximum  likelihood  estimate  is  found  by  determining  the  value  of  9*,  and 
the  value  of  w*  for  each  of  the  n  experiments,  which  minimizes  log(L)  while  satisfying 
the  n  equality  constraints  imposed  by  the  structural  model.    The  terms  w*  and  0* 
represent  the  maximum  likelihood  estimate  of  the  true  values  of  wp  and  0. 

To  find  the  maximum  likelihood  estimate  given  the  n  equality  constraints 
imposed  by  the  structural  model,  we  introduce  an  w-dimensional  vector  of  Lagrange 
multipliers  A,„  for  each  experiment.    We  then  form  the  Lagrangian  function: 


A(w,  e,  v,  xp...xn)  siog(i(w,  K))  +  £  V*(1Ve)     (2"23) 
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The  solution  to  the  estimation  problem  will  be  found  at  a  stationary  point  of  the 
Lagrangian  A(W,  9,  V,  Xu    ...,  \)    [Bard  1974]. 

To  demonstrate  the  benefits  of  using  this  approach,  we  look  at  the  contours  of 
the  Lagrangian  function  given  by  equation  (2-23).    Using  the  algorithm  developed  in 
section  2.6,  figure  2-3  shows  the  contours  of  the  Lagrangian  function  obtained  by 
using  the  same  experiment  vectors  used  to  generate  the  contours  of  the  normal 
weighted  least  squares  method. 
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Figure  2-3     Contours  of  the  Lagrangian  Function  A 

From  figure  2-3  we  see  that  the  contours  that  surround  the  true  position  of  the  acoustic 
beacon  are  much  less  eccentric  then  the  contours  of  the  normal  weighted  least  squares 
method.    Therefore,  we  do  not  have  the  large  variances  associated  with  the  major  axis 
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of  the  normal  weighted  least  squares  method,  and  the  estimate  of  the   parameter  vector 
6  will  be  more  accurate. 

To  solve  the  maximum  likelihood  estimator  problem  given  the  equality 
constraint  of  the  structural  model  we  use  an  iterative  method  suggested  by  Deming  as 
described  by  Bard    [Bard  1974].    We  define  the  parameter  vector  0*  as  the  estimate  of 
the  acoustic  beacon's  location  at  the  /th  iteration: 

e;  ■  t  V  V  t,'  ir  <2-24> 

We  also  define  the  estimated  true  experiment  vector  at  the  /th  iteration  as: 
and  the  corresponding  composite  experiment  vector: 


*T        'T  *r  ir 


Wt    =  [  Wi  .    w2  .  ...  wn  .  ]J 


(2-26) 


The  vector  W*  is  the  augmentation  of  the  n  estimated  true  experiment  vectors  w*  at 
the  /th  iteration.   We  then  define  a  composite  vector  valued  function  G(\V*  ,  0*)  where 
they'th  component  of  G(\V*  ,0*)  is  the  structural  model  evaluated  at   (w*  0*): 


G(w;t  en  =  g{  =  ig(*u\  en  g(w2i\  en  ...  g(wn.\  enr 

(2-27) 

Next  we  define  an  objective  function  as  the  weighted  least  squares  sum  of  the 
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residuals  given  by  equation  (2-20).    At  the  /th  iteration  the  objective  function  is: 

*<*/)  -  \'Y,  t\'-w*fyil  (V"w^        (2_28) 

This  is  the  same  form  as  the  last  term  in  equation  (2-22).    To  solve  for  the  Maximum 
Likelihood  Estimate,  the  objective  is  to  find  the  \V*   which  minimizes  log(L),  or 
equivalently,  0(\V*  )  subject  to  the  constraints   G(\V*  ,  0*)  =  0.    We  note  that  now  the 
unknown  parameters  that  we  are  estimating  are  the  acoustic  beacon's  location  as  well 
as  the  true  values  of  all  the  measurements. 

To  develop  a  solution,  we  define  the  following  terms: 

qx  b  d^(W*)/dW  <2"29) 

Hi  =  d2*  (  W*  )/dWdW  (2"3°) 

At  =  dG(W*y  Q-)/dW  (2"31) 

Bi  =  dG{W:,  0j)/dQ  (2-32) 

Next  we  expand  the  objective  function  in  a  Taylor  series  around  the  current  estimate 
of  W  and  0.    Keeping  only  up  to  the  second  order  terms  we  have: 

<f>,.(SJh  =  <S>.+qTihW  +  -hWTHibW  (2-33) 

Now  we  expand  the  structural  model  in  a  Taylor  series  around  the  current  estimate  of 
W  and  0.    Keeping  only  the  first  order  terms  we  have: 
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GiibW,  60)  =  G^A^W  +  B^Q  (2"34) 

To  find  the  maximum  likelihood  estimate  we  now  want  to  find  the  5\V  and  50 
that  minimize  <X>,  while  at  the  same  time  satisfies  the  structural  model  constraints 
G,  =  0.    To  do  this  we  introduce  the  vector  of  Lagrange  multipliers  X  and  look  for  the 
stationary  point  of  the  Lagrangian: 

V6#,  80>  xi) H  ftfCaJh  +  ifG,  (2~35) 

Forming  the  normal  equations  of  the  Lagrangian  and  using  equations  (2-33)  and  (2-34) 
we  have: 

dA^bW,  80,  X.)/d(bW)  =  qi  +  HihW  +  ATl\i  =  0  (2"36> 

dAt(bW,  80,  Xi)/dXi  =  Gi+AfiW+Bfid  =  0  (2"37) 

dA.(bW,  80,  Xt)/d(bQ)  =  BjX^O  (2"38) 

From  equation  (2-36): 


S^  =  -tf-iq^AjX.) 


(2-39) 


Substituting  equation  (2-39)  into  equation  (2-37)  we  have: 

GrAtH]lql-AtH;lAjxl*Bltd  =  0  (2"40) 

Solving  for  \: 

X^UitfAjy^iBtbO-Atfqt  +  Gt)  <2"41> 
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Now  substituting  equation  (2-41)  into  equation  (2-38): 

BTr{AiH-i[Ai)X'{BibQ-AiH^q^Gi)  =  0  (2"42> 

Solving  for  50  we  are  left  with: 


60  =  (Bj •(AiHrlAjyl-Biyl  -Bj-iA^Ajy1  -(Atf  qrGt) 

(2-43) 

We  can  define  a  new  term  G  as: 


C,.  eAtfAj  (2-44) 

and  a  term  D,  as: 

D,  -  Bj  C:1  Bt  (2-45) 

Substituting  equations  (2-44)  and  (2-45)  into  equation  (2-43)  gives: 

60  =  DjBjc]1  •  (A,. J*:1  qt  -  Gt)  (2"46) 

Once  we  have  calculated  59,  we  use  equation  (2-41)  to  calculate  the 
Lagrangian  multipliers  which  in  turn  are  substituted  into  equation  (2-39)  to  calculate 
the  updates  to  the  true  measurements.    Equations  (2-39)  and  (2-46)  then  allow  us  to 
iteratively  calculate  the  estimated  beacon  location  and  the  estimated  true  values  of  the 
measurements  with  the  recursion  relations: 

0*.  .  =  0*.+  60 

1+1  '  (2-47) 
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All  we  need  to  start  the  calculations  are  initial  values  for  0*  and  for  \V*.    Since  the 
measurement  errors  are  presumably  small,  we  can  use  the  actual  measured  values  W 
for  the  initial  values  of  \V*.    However,  since  we  have  no  idea  of  the  location  of  the 
acoustic  beacon,  the  choice  of  an  initial  value  for  0*  is  more  difficult.    In  the  absence 
of  any  other  information,  we  can  choose  the  center  of  the  search  area  for  the  initial 
value  of  0*. 

In  developing  the  solution  to  the  maximum  likelihood  estimate  we  made  the 
assumption  that  the  measurement  errors  are  normally  distributed  and  independent 
between  experiments.    To  determine  if  this  is  valid  we  refer  back  to  the  source  of  the 
measurement  errors.  The  measurement  error  TSM  is  not  normally  distributed.    However, 
if  we  do  not  make  the  assumption  of  a  normally  distributed  error,  and  stay  with  a 
uniform  distribution  of  errors,  we  will  be  unable  to  use  the  maximum  likelihood 
method.    This  is  because  likelihood  methods  use  gradient  techniques  to  maximize  a 
likelihood  function  which  is  based  upon  the  probability  distribution  function  of  the 
errors.    If  the  underlying  probability  distribution  function  is  not  smooth  and 
continuous,  there  will  not  be  a  unique  maximum,  and  a  useful  estimate  can  not  be 
found.   This  means  if  we  stay  with  the  uniform  distribution  we  will  be  forced  to  use  a 
more  computationally  expensive  direct  search  of  the  parameter  space,  or  minimax 
method  to  estimate  the  acoustic  beacon's  location. 

As  a  result  of  the  uniformly  distributed  errors  in  tSJJ,  the  solution  that  we  obtain 
from  the  maximum  likelihood  estimator  is  suboptimal.  There  is  also  a  chance  that  the 
method  used  to  find  the  estimate  that  maximizes  the  likeliness  function  will  diverge. 
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This  happens  when  the  estimate  of  the  true  value  of  tSM  is  further  away  from  the 
actual  true  value  of  tSM  then  the  quantization  of  the  time  base  allows.    To  prevent  the 
solution  from  diverging,  we  can  place  additional  constraints  upon  the  minimization  of 
the  objective  function  that  confine  the  solution  to  be  within  a  feasible  region.    We 
define  the  feasible  region  to  be  the  region  bounded  by  the  inequality  constraints: 

-Range^  ±  yT  <l  Range^  (2-48) 

Where  Rangemax  defines  the  size  of  the  search  area  that  we  are  willing  to  scan,  and 
Depthmax  is  the  maximum  depth  in  the  area  of  the  search.    The  beacon's  depth  is 
bounded  above  by  the  sea  surface  level.    If  the  solution  to  the  maximum  likelihood 
estimator  is  within  the  feasible  region,  we  accept  the  estimate.    If,  however,  the 
solution  to  the  maximum  likelihood  estimator  is  outside  the  feasible  region  we  must 
adjust  the  estimator  to  bring  the  solution  inside  the  feasible  region,  or  in  the  worst 
case,  disregard  the  estimate. 

To  maintain  a  feasible  solution  we  break  equation  (2-47)  into  component  parts: 

ev,  =  ey  se  =  e*,.  +  Pe  ue 

(2-49) 

A      *  A      *  A  A     * 

W'M  -W,+  iW-W,  +  ptUt 

where  Ue  and  U^  are  unit  magnitude  vectors  that  describe  the  direction  of  50  and 
8W,  and  pe   and  p£  are  the  magnitudes  of  89  and  5W.    We  assume  that  50,  and 
hence  Ue,  points  in  the  proper  direction  to  the  maximum  likelihood  estimator.    If 
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0*+  5G  is  outside  the  feasible  region  defined  by  equation  (2-48),  we  find  the 
maximum  value  of  p  which  satisfies: 


-Ranges 

tonge^ 

-tomgtmn 

<  V  +  Pn^e  < 

Kange^ 

Depths 

0 

(2-50) 


Once  we  have  found  pmax  we  replace  pe  and  pw   in  equation  (2-49)  which  gives  the 
new  update  equations: 


ft 

ft 


(2-51) 


This  essentially  shortens  the  step  that  we  move  in  updating  9*  and  W*  for  the  iteration. 
Notice  that  we  do  not  simply  replace  p9  and  pw  with  pmax.    If  we  did  this,  0*+1  would 
be  on  the  edge  of  the  feasible  region.    With   0*+1  on  the  edge  of  the  feasible  region, 
pmax  will  be  zero,  and   0*+I  will  equal   0*  for  all  subsequent  iterations.    If  this  happens 
we  will  be  unable  to  achieve  any  further  updates  of  0*+1  and  W-.     It  is  still  possible 
that,  after  a  certain  number  of  iterations,  0*+1  lies  on  the  edge  of  the  feasible  region.    If 
this  happens  we  must  reject  the  estimate  and  try  again  using  a  different  initial  value 
for  0*  or  more  experimental  data  points. 
2.6    Algorithm 

Figure  2-4  at  the  end  of  this  section  describes  the  algorithm  used  to  estimate 
the  location  of  the  acoustic  beacon  based  on  Deming's  method  as  described  by  Bard. 
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There  is  no  natural  way  of  telling  whether  or  not  progress  towards  the  solution  has 
occurred  in  any  given  iteration  when  we  use  this  method  [Bard  1974].     Bard  suggests 
calculating  the  quantities: 

(2-52) 


zo  =  IX<  V-  e*)r  V1  W>  e-:) 

11=1 


and: 


zi  -  £  W+5>v  Qi  +60)r  V1  W+6>v  6'r+60)     (2"53) 

The  rational  behind  these  quantities  follows  that  at  the  true  values  of  W  and  6, 
G(W,  0)  must  equal  zero.   If  Q,  is  a  positive  definite  matrix,  we  require  that: 

o  ( Kv  0m  )r  Qi  g  ( Kv  *U  )  *  o  ( w? ,  e;  )r  <?,.  g  ( #; ,  0; )   <2-54) 

This  means  that  as  \V*  and  0*  approach  the  true  values  of  W  and  0,  the  quantity 
G(\V*,  0*)T  Q,  G(\V*,  0*)  must  decrease.    The  natural  choice  for  Q,  is  the  inverse  of 
the  covariance  matrix  of  G(\V*,  0*)  [Bard  1974].    With  VM  as  the  covariance  matrix  of 
the  measurements,  the  covariance  matrix  of  G(W*,  0*)  is  approximately: 


ii=i 


(2-55) 


Now  from  equation  (2-30)  we  have: 


H.  =  &&(W*)/dWdW  = 


v;1  o    ...      o 


o    v; 


o 


(2-56) 
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So  we  choose: 

<?,  ■■  COV(  G  ( wrfi; ))-'-(  £  a,,  K,  ^ )   =  (A ,  #:'  Af)"  =  C? 

(2-57) 
It  then  follows  that:  [Bard  1974] 


G{wt\  e; )r  e,  g ( *;,  e; )  =  £  ^ ( ^; ,  e;  f  c^  g]> ( *  •,  e; ) 

(2-58) 

If  Z,  is  less  then  Z0,  we  accept  80  and  5\V  and  continue  to  the  next  iteration.    If  Z,  is 
greater  then  Z0,  we  shorten  89  and  8\V  and  then  recalculate  Z,. 

To  determine  when  to  stop  the  algorithm  we  follow  the  termination  criterion  of 
Marquardt  [Bard  1974].    We  define  a  tolerance: 

^^•(KL*10"3)  (2-59) 

where  |  0*  |min  is  the  smallest  component  of  0*.   The  term  10'3  is  added  in  case 
|  0*  |min  is  close  to  zero.   For  each  iteration  we  check  to  see  if  I  80  lmin   is  less  then 
8;.    If  I  80  lmin   is  less  then   s„  we  terminate  the  algorithm.  If  I  80  lmln   is  not  less 
then   8„  we  continue.    For  each  iteration  we  calculate  a  new  tolerance  value  e,.    This 
leads  to  a  conservative  termination  criterion  that  will  stop  the  algorithm  if  the 
parameter  values  cease  changing. 

To  start  the  algorithm  we  choose  an  initial  guess  of  the  location  of  the 
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acoustic  beacon,  0O*.    We  then  use  the  measured  values  of  W  for  the  initial  values  of 
\V*.    For  each  experiment  n,  we  calculate: 


e» H  V  -  *v 


\  =  dg^/dw 


\  =d8vL/dQ 


(2-60) 
(2-61) 
(2-62) 


For  the  case  of  the  stationary  beacon    aM    is  given  by: 


and  b   is  given  by: 


a    = 


(Xi-Xt) 


J<ti-xrf+iti-yrf+&f 
(Si-yr) 

-C 


*      * . 


(<*2      Xt) 


J(X2-Xr)2+(y2-  yr)2+  Ut)2 

(yj-yj-) 

J<ti-xrf+(ti-y}f+tz;t 

+  c 


(2-63) 
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h- 


(*2~*r) 


(i,  -xT) 


ft&-  Xr)2Hy2~  >Y)2  +  Ur)2      JiXi*  ~  Xrf+iSi*  -  yT)2  +  (tTY 


($2-yT) 


(Si-yr) 


ft&T  %)2+(^2  "  yr)2+(ZT)2      V^»  "  xt )2 +& ~yr)2+(Zr  f 


ZT 


ZT 


ft&  -  Xj  )2 +(yf  -yr)2+(ZT  f      /<&  -  Xt)2+($2-  >r)2+Ur)2 


(2-64) 


Once  we  have  aM  and  bM,   we  calculate: 


c    =  a  T  V  a 

11  n         u      it 


(2-65) 


7     ^g(y,e*)2 

,1  =  1  Cn 


(2-66) 


and: 


/  j\ 


VCM 


&  2> r 


(2-67) 


Using  equation  (2-46)  we  can  solve  for  50: 


60  =D-1.£(i-)-(«/^  -«(V.^))-*P 


(2-68) 


Now  using  equation  (2-41)  we  calculate  the  Lagrangian  multipliers: 


V 


'i* 


\c*> 


(6,r  66 -«/«„  +  *(*„*.  e*))  <2"69> 
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and  finally  we  calculate: 


**, =  -^  -  K  v*  %  <2-70) 


Once  we  have  50  and  5\V   we  check  to  see  if  0*+  80  is  in  the  feasible  region.    If 
0*+  50  is  not  in  the  feasible  region,  we  adjust  the  step  size  of  50  as  describe  earlier. 
Once  we  have  a  feasible  step  for  50,  we  calculate: 

Zi  .  £  soy  aye- +ae)'  (2.71) 

If  Z,  is  less  then  Z0,  we  accept  the  values  of  60  and  5VV   and  update  0*  and  W"  using 
equation  (2-47).  We  then  move  to  the  next  iteration.    If  Z,  is  greater  then  Z0,  we 
assume  that  we  have  overshot  the  maximum  likelihood  estimate,  shorten  50  and  5\V 
by  a  factor  of  two,  then  recalculate  Z,.    We  continue  this  process  until  Z,  is  less  then 
Z0,  or  until  50  is  negligible,  at  which  point  we  have  to  stop  the  algorithm  and  begin 
again  with  a  new  initial  value  for  0*,  or  more  experimental  data  points. 
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From   Figure   2-4. a 


Calculate   Z       equation    (2-66) 


Calculate     A      equation    (2-69) 

n 
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From   Figure   2-4. b 
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2.7    Accuracy  of  the  Estimation 

One  of  the  benefits  of  using  Deming's  method  for  the  maximum  likelihood 
estimate  is  that  the  covariance  of  the  estimated  parameters  is  approximated  by  the 
inverse  of  the  matrix  D  defined  by  equation  (2-45)  [Bard  1974].    This  lets  us  quickly 
determine  if  the  estimation  of  the  acoustic  beacon's  position  is  acceptable,  or  if  more 
experimental  data  needs  to  be  collected  to  improve  the  estimation.    We  are  also  able  to 
test  if  the  assumptions  made  regarding  the  covariance  matrix  of  the  measurement 
errors  are  valid  by  examining  the  final  residual  vectors.    We  define  a  moment  matrix 
M  as: 


M  =  £  e;  e;T  (2-72) 


where  the  e*  's  are  the  final  residual  vectors.    To  estimate  the  covariance  of  the 
residuals  we  take: 


K  =  — -M  (2-73) 

rt-3 

where  n  is  the  number  of  experiment  vectors  used  in  the  maximum  likelihood 
estimation.    Because  of  the  nature  of  the  constrained  minimization  problem,  the  first 
term  in  equation  (2-73)  is  needed  to  correct  for  bias  [Bard  1974].    We  can  compare 
the  outcome  of  equation  (2-73)  to  the  assumed  covariance  matrix  VM  defined  by 
equation  (2-17)  to  see  if  the  estimated  covariance  matrix  VM  is  valid. 
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2.8    Summary 

In  this  chapter  we  have  developed  the  maximum  likelihood  estimate  of  the 
acoustic  beacon's  position,  and  a  means  in  which  to  gauge  the  accuracy  of  the 
estimation.    To  estimate  the  beacon's  position  we  defined  a  structural  model  that 
requires  the  observer  to  measure  the  time  of  receipt  and  location  of  receipt  of  two 
different  signal  from  the  acoustic  beacon.    The  choice  of  how  far  apart  the  two  signals 
that  define  an  experiment  vector  (wM)  must  be,  and  the  number  of  experiment  vectors 
to  use  in  the  parameter  estimation  problem  (n)  remain  as  free  parameters.    In  chapter 
IV  we  examine  the  performance  of  the  algorithm  of  this  chapter  for  different  choices 
of  these  two  free  parameters. 
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Chapter  III 
Moving  Acoustic  Beacon 
3.1    Introduction 

In  chapter  II  we  developed  the  maximum  likelihood  estimator  for  a  stationary 
acoustic  beacon.    In  this  chapter  we  extend  the  solution  to  include  a  moving  acoustic 
beacon.  The  task  of  localizing  an  arbitrarily  moving  acoustic  beacon  is  quite  difficult. 
Abrupt  changes  in  the  acoustic  beacon's  velocity  are  difficult  to  parameterize  and 
model.   Therefore,  we  concentrate  on  the  case  of  an  acoustic  beacon  which  moves  in  a 
constant  velocity,  linear  path.    The  assumption  of  constant  velocity,  linear  motion  is  a 
reasonable  assumption  for  acoustic  beacons  located  on  instruments  ascending  at 
terminal  velocity  from  the  bottom,  or  for  acoustic  beacons  located  on  instruments 
moving  with  an  ocean  current  that  is  steady  in  the  area  of  interest.    With  the 
assumption  of  constant  linear  motion,  we  modify  the  structural  model  given  by 
equation  (2-19)  to  include  parameters  that  reflect  the  acoustic  beacon's  velocity.    Once 
the  new  structural  model  is  defined,  we  show  that  the  solution  to  the  maximum 
likelihood  estimate  for  the  moving  beacon  follows  directly  from  the  solution  to  the 
maximum  likelihood  estimate  for  the  stationary  acoustic  beacon.    Next,  the  algorithm 
developed  to  solve  the  stationary  acoustic  beacon  localization  problem  is  extended 
using  the  new  structural  model  so  that  the  position  and  velocity  parameters  of  the 
moving  acoustic  beacon  can  be  determined.    Finally,  the  accuracy  of  the  estimator  is 
examined. 
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3.2    Problem  Geometry 

Consider  an  acoustic  beacon  having  constant  velocity  components  given  by 
vx,  vy,  and  v2.    We  define  a  new  parameter  vector: 


9    =   t  Xo     yo     Zo     Vx     Vy     Vz  ^ 


(3-1) 


where   the  coordinates  x0,  y0,  and  z0  define  the  acoustic  beacon's  initial  position  on  the 
same  Cartesian  coordinate  system  that  was  described  in  chapter  II.    For  convenience, 
we  assume  the  velocity  components  vx,  vy,  and  vz  have  the  units  of  meters  per  second. 
The  position  of  the  acoustic  beacon  at  an  arbitrary  time  tp  can  by  found  using: 


#T"T* 

Xo 

yT 

= 

y0 

T 

.  v 

+  «rTJ 


(3-2) 


where  T0  is  the  reference  time  that  corresponds  to  the  acoustic  beacon's  initial  position 


Xo»  Yo»  Zo 


As  in  chapter  II,  we  define  a  measurement  vector  m   as: 


»n  "  [  *n    y*    **»  ]J 


(3-3) 


Where  xM  and  yM  are  the  ship's  coordinates,  in  meters,  on  the  same  local  Cartesian 
coordinate  system  defined  for  the  acoustic  beacon,  and  tSfJ  is  the  synchronized  time  of 
receipt  that  corresponds  to  the  observer's  position  xp,   y  . 
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3.3    Modified  Structural  Model 

To  account  for  the  linearly  moving  acoustic  beacon,  we  redefine  the  function 
("(m^  0)  from  chapter  II  as: 


where  tp  represents  the  time  that  the  acoustic  beacon  transmitted  the  signal  that  the 
observer  received  at  the  synchronized  time  of  receipt  tSM.    Using  the  same 
homogeneous  ocean  model,  and  direct  path  propagation  from  chapter  II,  we  simplify 
equation  (3-4)  to: 

(3-5) 
-  C(t    -T) 

Now  assume  that  at  time  T0  the  acoustic  beacon  transmitted  the  first  signal  that  the 
observer  receives.    To  find  when  the  current  signal  received  at  the  synchronized  time 
of  receipt  tSM  was  transmitted,  we  note  that  the  acoustic  beacon  transmits  a  signal  for 
every  pulse  repetition  interval.    With  T0  as  a  reference,  tp  can  be  found  by: 

H'T.  +  t-T,  (3-6) 

where  Tp  is  the  pulse  repetition  interval  of  the  acoustic  beacon  and  /'  is  number  of 
pulse  repetition  intervals  that  separate  the  signal  transmitted  at  time  tp   from  the  signal 
transmitted  at  reference  time  T0.    To  determine  i,  the  observer  counts  how  many 
signals  are  received  between  the  first  received  signal  and  the  signal  received  at  the 
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synchronized  time  of  receipt  tS(1.    Simplifying  equation  (3-5)  to  eliminate  T0  and  tp,  we 
substitute  equation  (3-6)  into  equation  (3-5)  which  yields: 


J&V  e)  =  \l^-^-i'TP^f+(y,-yo-i'T/yy)2Hz0n'Tp-vf 

(3-7) 


Now,  just  as  in  the  case  of  the  stationary  acoustic  beacon,  we  must  eliminate  the 
dependence  on  the  time  reference  T0  from  the  last  term  in  equation  (3-7). 

To  eliminate  the  dependence  upon  the  time  reference  T0,  we  define  the  function 
g(m„  m2,  0)  as: 

g(mv  ro2,  0)  =  f(mv  8)-/(m2,  6)  (3-8) 

Substituting  equation  (3-7)  into  equation  (3-8)  with  m,  for  the  first  received  signal  and 
m2  for  the  second  received  signal  we  have: 

g(mvm»e)  =  ^rxe-i'Tp-vf*(yry0-rTp'V^(^hTp'vf 

-^-x.-j'Tyvf^-y^j'Tyv/Hz^j-Tyvf        (3"9) 

-c-(tsl-ts2) 

Simplifying  notation  as  in  equation  (2-13),  and  showing  the  dependence  upon  the  true 
value  of  the  measurements,  we  define  the  structural  model  for  the  case  of  the  moving 
acoustic  beacon  as: 
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This  is  analogous  to  equation  (2-19)  with  additional  terms  included  to  correct  for  the 

beacon's  motion. 

3.4    Maximum  Likelihood  Estimator  Solution 

The  solution  to  the  maximum  likelihood  estimation  problem  for  the  case  of  the 
moving  acoustic  beacon  follows  directly  from  the  solution  to  the  maximum  likelihood 
estimation  problem  for  the  case  of  the  stationary  acoustic  beacon.    Since  only  the 
structural  model  has  changed,  the  likelihood  function  log  (L  (\V,  V)),  the  Lagrangian 
function  A(\V,  0,  V,  Xx,  ...  ,Xn)  and  the  objective  function  <X>(  W*)  all  have  the  same 
form  as  the  corresponding  functions  defined    for  the  stationary  beacon.    To  solve  for 
the  maximum  likelihood  estimator  of  the  parameter  vector  0,  we  simply  substitute  the 
modified  structural  model  given  by  equation  (3-10)  for  the  stationary  structural  mode 
given  by  equation  (2-19),  and  follow  the  method  of  Deming  described  in  chapter  II. 
There  are,  however,  a  few  differences  that  must  be  accounted  for. 

If  the  measurement  errors  are  the  same  for  both  cases,  we  still  expect  the 
solution  to  the  maximum  likelihood  estimator  to  be  suboptimal.    Because  of  the 
uniform  distribution  of  the  measurement  errors  TSM,  we  must  continue  to  confine  the 
solution  of  the  maximum  likelihood  estimation  problem  to  a  feasible  region.    With  the 
addition  of  the  parameters  vx,  vy,  and  vz  to  0,  we  expand  the  feasible  region  defined  by 
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equation  (2-48)  to: 


-Depth***  *  z0  <;  0 
-v_     s  v„  £  v_ 

max  max 


-v        £  V    £  V 


-v        £  V    £  V 

^max  *  *nnx 


(3-11) 


As  in  chapter  II,  to  maintain  a  feasible  solution,  we  break  50  into  component  parts: 

e;+1  =  e;+6e  =  e;  +  Pei/e  (3_12) 

where  U6  is  unit  magnitude  vector  that  describes  the  direction  of  50,  and  pe  is  the 
magnitude  of  50.    We  assume  that  50,  and  therefore  Ue  ,  points  in  the  proper 
direction  to  the  maximum  likelihood  estimator.    If  0*+  50  is  outside  the  feasible 
region  defined  by  equation  (3-11),  we  find  the  maximum  value  of  p  that  satisfies: 


•Rang*** 
Range^ 

-Depths 


-v. 


-v.. 


-v. 


*max 


<0,r  +  Pm«i/e< 


0 

TBI 

V 

./max 


(3-13) 


Once  we  have  found  pmax,  we  define  the  new  recursion  relations: 


49 


e;+1  =e;  +  ^tfe 

(3-14) 

As  with  the  case  of  the  stationary  acoustic  beacon,  if,  after  a  few  iterations,  0*  lies  on 
the  edge  of  the  feasible  region,  pmax  will  be  zero  and  0*+1  will  equal  0*   for  all 
subsequent  iterations.    If  this  happens  we  reject  the  estimate,  and  try  again  using  a 
different  initial  value  for  0*  ,  or  more  experimental  data  points. 
3.5   Algorithm 

Figure  3-1  at  the  end  of  this  section  describes  the  algorithm  used  to  solve  for 
the  acoustic  beacon's  position  and  velocity.    The  algorithm  is  essentially  the  same 
algorithm  developed  in  chapter  II  with  changes  made  to  account  for  the  modified 
structural  model  of  equation  (3-10).     Because  of  the  modified  structural  model,  we 
must  reevaluate  the  quantities  aM   and  bM     From  equation  (3-10),  we  define  the 
quantities: 

4  s  M*  <  -i-T,<? +(yr  -y:  -*  v/>2 + &  **,-»;? 


(3-15) 


d2  -^-x;-j-Tp-v;)2+(y;-y;-j-Tp-v;)2+(z;v-Tp'yzy 


(3-16) 


a   and  b    are  then  given  by: 
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(3-17) 
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To  evaluate  the  structural  model,  and  the  terms  aM  and  bM  ,we  need  to  know  the 
values  of  i  and  j  that  represent  the  time  that  the  received  signals  were  transmitted. 
This  forces  the  observer  to  keep  a  count  of  the  number  of  signals  that  are  received, 
with  the  first  received  signal  corresponding  to  /'  =  0. 

Once  we  have  found  the  maximum  likelihood  estimate  of  the  parameter  vector 
0,  we  need  to  evaluate  the  estimated  current  position  of  the  acoustic  beacon.    The 
position  defined  by  x0*,  y0\  z*  is  the  estimated  initial  position  of  the  acoustic  beacon 
at  the  time  T0.   We  assume  that  the  time  T0  corresponds  to  the  case  /'  =  0.    To 
determine  the  current  position  of  the  acoustic  beacon,  we  project  the  solution  forward 
along  the  path  described  by  the  estimated  velocity  components  vx\  vy\  vz*.    The 
estimated  current  position  of  the  acoustic  beacon  is  then  given  by: 


* 

Xt 

* 

* 
VX 

yr 

= 

y*0 

•I'T, 

vy 

Zt 

* 

* 
vz 

(3-19) 


where  /  is  the  total  number  of  beacon  signals  received  and  Tp  is  the  pulse  repetition 
interval  of  the  acoustic  beacon.    The  quantity  (/'  ■  Tp)  represents  the  time  it  took  to 
collect  the  measurements  used  to  calculate  the  maximum  likelihood  estimator. 
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From   Figure   3-1. a 
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From   Figure   3-l.b 
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3.6    Accuracy  of  the  Estimator 

To  estimate  the  accuracy  of  the  solution  to  the  maximum  likelihood  estimator, 
we  examine  the  estimated  covariance  matrix  of  the  parameter  vector  0.    As  with  the 
stationary  beacon,  the  estimated  covariance  matrix  of  the  parameter  vector  9  is  given 
by  the  inverse  of  the  matrix  D  or: 


/     n 


V;={BTC-*Br=     £     J- 


b    b 


(3-20) 


The  variance  of  the  velocity  components  vx\  vy*,  and  vz*  are  the  last  three  diagonal 
elements  of  the  covariance  matrix  Vq. 

To  determine  the  variances  of  the  current  acoustic  beacon  position  estimates  we 
calculate: 


<  ■  *[((*.  +  *-T,  v,)  -E[x,* i-Tp  vz]f] 


(3-21) 


«* -*[(fct'-VP-*[>'.+'-V,]f] 


(3-22) 


•* -'[(Cv'-VP-flv'-VJf] 


Simplifying  equations  (3-21)  through  (3-23)  yields: 


(3-23) 


-  E[x0]^ -2V-Tp)E[vx]E[x0]-^Tp'E[vx]j 


(3-24) 


2    _    „    2 


yr 
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(3-25) 


2 2    .    is.t  \2  .„   2 


V  -  V  +  CW-  V  +  2-(<T,)£Kn]  (3.26) 

Now  if  we  assume  that  the  estimate  of  the  parameter  vector  0  is  unbiased,  we  can 
substitute  the  estimated  parameter  values  for  their  means  in  equations  (3-24)  through 
(3-26).    This  gives  us  a  method  in  which  to  calculate  the  estimated  variance  of  the 
projected  current  position: 


°*-°*+(t'T,f'°*+2V'T,)*[*.v*] 

-(x;)2-2'(i-Tp)v;x;-(i-Tp-v;f 


(3-27) 


2    _ 


-  tir -2-(i-Tr)v,y; -(i-Tr-v;f 


(3-28) 


(3-39) 


-  (O2  -2-(i-Tp)V;  z:  -{i-T,-v;f 

From  equations  (3-27)  through  (3-29)  we  see  that  the  variance  of  the  estimated  current 
position  has  a  complex  relationship  to  the  number  of  experiment  vectors  used  and  the 
effective  sensor  spacing.  As  these  quantities  increase,  we  expect  that  the  variances  of 
the  estimated  initial  positions  and  velocities  will  decrease.  However,  as  the  number  of 
experiment  vectors  used  and  the  effective  sensor  spacing  increases,  the  term  /*  will 
increase  and  the  variance  of  the  estimate  of  the  current  position  of  the  acoustic  beacon 
can  also  increase.  This  is  because  if  we  project  the  initial  position  of  the  acoustic 
beacon  forward  based  on  the  estimated  velocity  parameters,  any  errors  in  the  acoustic 
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beacon's  velocity  causes  us  to  move  the  estimate  in  the  wrong  direction.    The  choice 
of  how  many  experiment  points  to  collect,  or  how  long  we  spend  collecting  data 
points,  will  be  examined  in  chapter  IV. 

As  with  the  stationary  beacon,  we  can  test  the  assumptions  made  regarding  the 
covariance  matrix  of  the  measurement  errors.    We  define  the  moment  matrix  as: 

where  the  e*  's  are  the  final  residual  vectors  defined  as  in  chapter  II.   To  estimate  the 
covariance  of  the  residuals  we  take: 

V=—-M  (3-31) 

n  -6 

where  n  is  the  number  of  experiment  vectors  used  in  the  maximum  likelihood 
estimation.   The  first  term  in  equation  (3-31)  corrects  for  the  bias  caused  by  the 
constrained  minimization  problem  [Bard  1974].    We  can  compare  the  results  of 
equation  (3-31)  with  the  assumed  covariance  matrix  of  the  measurement  errors  to 
judge  if  the  assumed  covariance  matrix  VM  is  valid. 
3.7    Summary 

In  this  chapter  we  have  extended  the  results  of  chapter  II  to  include  linear 
motion  of  the  acoustic  beacon.    We  found  that  the  solution  to  the  maximum  likelihood 
estimator  for  the  case  of  the  moving  beacon  follows  the  same  form  as  the  solution  for 
the  case  of  the  stationary  beacon.     The  quantity  (J  -  i)  is  one  of  the  free  parameters  of 
the  moving  acoustic  beacon  estimation  problem.    We  define  this  quantity  as  the 
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effective  sensor  spacing.    This  quantity  corresponds  to  the  spacing  in  time  between  the 
two  signals  used  to  form  the  experiment  vector  wM.    The  other  free  parameter  is  the 
number  of  experiment  vectors  to  use  in  the  parameter  estimation  problem.    In  the  next 
chapter  we  examine  the  performance  of  the  algorithm  described  in  this  chapter  for 
different  choices  of  the  two  free  parameters. 
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Chapter  IV 
Algorithm  Simulations  and  Tests 
4.1    Introduction 

In  chapters  II  and  III  we  developed  algorithms  to  solve  for  the  maximum 
likelihood  estimate  of  an  acoustic  beacon's  position  for  both  the  stationary  and  the 
moving  beacon.    In  both  chapters  we  were  left  with  choosing  how  many  experiment 
vectors  (wM)  to  use,  and  which  measurement  vectors  (mM)  to  use  to  define  the 
experiment  vectors.    We  defined  the  effective  element  spacing  to  be  the  number  of 
pulse  repetition  intervals  (Tp)  between  the  measurement  vectors  that  form  the 
experiment  vector  w      In  this  chapter  we  examine  the  performance  of  the  algorithms 
developed  in  chapters  II  and  III  for  different  numbers  of  experiment  vectors,  and  for 
different  effective  element  spacings.    We  show  that  the  accuracy  of  the  estimated 
beacon  position  (0*)  improves,  while  the  variance  of  the  estimated  position  decreases 
as  the  number  of  experiment  vectors  used  to  find  the  maximum  likelihood  estimate 
increases.    We  also  show  that  the  accuracy  of  the  estimated  beacon  position  improves, 
and  the  variance  of  the  estimated  position  decreases  with  increased  effective  sensor 
spacing.    This  result  is  similar  to  the  methods  mentioned  in  chapter  I. 

To  test  the  algorithms  of  chapters  II  and  III,  Monte  Carlo  simulations  were 
conducted  for  several  different  initial  positions  and  velocities  of  the  acoustic  beacon. 
Results  from  six  of  the  scenarios  tested  are  presented  in  the  following  sections.    We 
assume  that  the  measurement  errors  are  as  defined  in  section  2.4.    To  see  how  the 
accuracy  of  the  measured  position  of  receipt  (xM,  yM)  affects  the  maximum  likelihood 
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estimate,  we  use  GPS  errors  of  3  meters  rms  and  25  meters  rms.    These  errors 
approximate  the  errors  of  a  Differential/P  code  GPS  receiver  and  a  C/A  code  GPS 
receiver  respectively.    For  measurement  errors  in  the  synchronized  time  of  receipt  t  , 
we  assume  the  sampling  rate  of  the  receiver,  Ts,  is  1  millisecond  and  use  equation  (2- 
16)  to  define  the  variance. 
4.2    Synthetic  Measurement  Vector  Generation 

To  test  the  algorithms  of  chapters  II  and  III,  synthetic  measurement  vectors 
were  generated  for  several  different  acoustic  beacon  positions  and  velocities.    Table 
4-1  lists  the  initial  position  and  velocities  for  each  of  the  scenarios  presented.    We 
assume  that  the  receiving  ship  moves  in  a  hexagonal  search  path  with  legs  of  1000 
meters.   This  is  a  reasonable  search  path  in  the   general  location  of  the  acoustic 
beacon  which  is  easy  to  model.   The  actual  path  of  the  receiving  ship  is  not  critical, 


Scenario 

*B 

(m) 

yB 

(m) 

ZB 

(m) 

(m/s) 

(m/s) 

(m/s) 

1 

0 

0 

-2000 

0 

0 

0 

2 

0 

866 

-2000 

0 

0 

0 

3 

-1000 

1000 

-2000 

0 

0 

0 

4 

0 

0 

-2000 

0.5 

-0.5 

0.25 

5 

0 

866 

-2000 

0.5 

-0.5 

0.25 

6 

-1000 

1000 

-2000 

0.5 

-0.5 

0.25 

Table  4-1 

as  long  as  it  is  not   linear.    If  the  receiving  ship's  path  is  linear  we  will  be  unable  to 
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accurately  resolve  the  acoustic  beacon's  position  in  three  dimensions.    This  is 
analogous  to  the  inability  of  a  conventional  linear  array  to  resolve  the  direction  of 
arrival  of  a  signal  in  two  dimensions.    We  restrict  the  speed  of  the  receiving  ship  to 
five  meters  per  second  so  that  flow  noise  does  not  become  a  problem. 

Figure  4-1  shows  the  positions  of  the  acoustic  beacon  for  the  scenarios  defined 
in  Table  4-1  compared  to  the  path  of  the  receiving  ship. 


Scenarios   3   &    6 

O  4 


Starting   Point 


& 


Scenarios   2    &    5 


& 


Scenarios/ 1    &   4 


Receiving    Ship's 
Course 


O  Initial   Beacon 
Location 


Figure  4-1 

Scenarios  1  and  4  corresponds  to  an  acoustic  beacon  located  in  the  center  of  the  search 
path,  scenarios  2  and  5  correspond  to  an  acoustic  beacon  located  directly  below  the 
search  path,  and  scenarios  3  and  6  correspond  to  an  acoustic  beacon  located  outside  of 
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the  search  path. 

To  generate  the  synthetic  measurement  vectors  mM,  we  solve  for  the  intercept  of 
the  receiving  ship  and  the  beacon  signal.    Figure  4-2  shows  the  intercept  geometry. 

(x  .  y„.  o) 


Beacon   Signal 


y  cse 


(x,  .   yt  ,    0) 


Acoustic   Beacon 
Location 

0*8 .  >v  zb) 

Figure  4-2 

The  position  xj5  y,  is  the  location  of  the  receiving  ship  when  the  beacon  signal  is 
transmitted,  and  the  position  xM,  yM  is  the  location  of  the  ship  when  the  beacon  signal 
is  received.    Using  a  homogeneous  ocean  model  and  a  direct  path  propagation  mode, 
we  calculate  the  synchronized  time  of  receipt  by  finding  the  positive  root  of: 


a  -t2  +  p  -t  +y  =0 


(4-1) 


where: 


a  =s2-C2 

p  =  2  s  -[cos(cse)ixrxB)  +  sin^eXy,-^)] 

Y  ■  (xrxBf  +  (yryB¥+zl 
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(4-2) 


Here  s  is  the  speed  of  the  receiving  ship  in  meters  per  second,  C  is  the  speed  of  sound 
in  sea  water,  and  cse  is  the  course  of  the  receiving  ship  in  degrees.    It  is  assumed  that 
the  receiving  ship  does  not  change  its  course  for  the  duration  of  the  calculation.    Once 
we  have  the  synchronized  time  of  receipt,  we  calculate  the  position  of  receipt   x„,  yM 
using: 

*u  =  xt  +  t    -s-cos(cse) 

(4-3) 

>V  =  yt  +  tSil'S'sm(cse) 

To  find  the  next  synchronized  time  of  receipt  and  position  of  receipt   (xp,  yM) 
we  update  the  acoustic  beacon's  position  based  on  its  velocity: 


XB        XB  +  *p'Vx 


yB=yB  +  Tp'vy  <4"4> 


*B   =ZB  +  Tp'Vz 


where  Tp  is  the  pulse  repetition  interval  of  the  acoustic  beacon.   For  the  results 
presented  in  the  following  sections  we  assume  the  acoustic  beacon  has  a  pulse 
repetition  interval  of  2  seconds.    Next  we  find  the  location  of  the  receiving  ship  when 
the  new  beacon  signal  is  transmitted  using: 

jCj  =  x.  +  T 'ms  •  cos(cse) 

(4-5) 

y-i  =  yi  +  Tp-s-sm(cse) 

We  then  solve  for  the  intercept  of  the  beacon  signal  and  the  receiving  ship  using 
equations  (4-1)  and  (4-2).  We  continue  in  this  manner  until  we  have  generated  a 
sufficient  number  of  measurement  vectors  mM.    Once  we  have  generated  the 
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measurement  vectors,  we  add  normally  distributed  random  error  terms  to  each 
measurement  based  upon  the  errors  discussed  in  section  2.4. 
4.3    Stationary  Acoustic  Beacon 

In  this  section  we  examine  the  performance  of  the  algorithm  given  in  Figure 
2-4.    Figures  4-3  through  4-50  contain  the  results  of  the  Monte  Carlo  simulations 
conducted  for  scenarios  1  through  3.    For  each  scenario,  the  initial  value  of  the 
estimated  parameter  vector  0*  is  taken  as: 

0o  =  [  0    0    -2500  ]T  (4"6> 

The  feasible  region  is  defined  by  Rangemax  =  Depthmax  =  5000  meters.    If  the  maximum 
likelihood  estimate  found  using  the  algorithm  of  chapter  II  is  outside  the  feasible 
region,  the  corresponding  entries  are  left  blank.    To  find  a  solution  for  these  cases,  we 
need  to  start  with  a  different  initial  parameter  vector  9*,  or  use  more  experiment 
vectors. 

To  test  the  effect  of  increasing  the  number  of  experiment  vectors  («),  we  solve 
for  the  estimated  parameter  vector  0*  using  n  ranging  from  5  to  50.    We  fix  the 
effective  sensor  spacing  at  45  pulse  repetition  intervals  by  using  every  45th  received 
beacon  signal  in  defining  the  experiment  vectors.   To  test  the  effects  of  increasing  the 
effective  sensor  spacing,  we  solve  for  the  estimated  position  vector  using  effective 
sensor  spacings  ranging  from  2  to  90  pulse  repetition  intervals.    For  this  case  we  fix 
the  number  of  experiment  vectors  used  to  25.   We  conduct  each  experiment  using  GPS 
errors  of  3  meters  rms  and  25  meters  rms.   The  results  of  the  estimation  algorithm  for 
GPS  errors  of  3  meters  rms  are  shown  by  x's  on  the  plots,  while  the  results  of  the 
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estimation  algorithm  for  GPS  errors  of  25  meters  rms  are  shown  by  o's. 
4.3.1    Scenario  1  -  Stationary  Acoustic  Beacon  Located  at  0  =  [0  0  -2000]T 

Figures  4-3  through  4-10  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-1 1 
through  4-18  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  1.    We  see  that  in  general,  as  the 
number  of  experiment  vectors  used  in  the  maximum  likelihood  estimation  problem 
increases,  the  accuracy  of  the  estimated  beacon    position  improves,  and  the  standard 
deviation  of  the  estimated  position  decreases.    Also,  as  the  effective  sensor  spacing 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  and  the  standard 
deviation  of  the  estimated  position  decreases.    For  both  cases,  the  position  errors  and 
the  standard  deviation  of  the  estimates  initially  decrease  rapidly  as  the  receiving  ship 
spans  more  of  its  two  dimensional  search  path.   However  after  the  number  of 
experiment  vectors  used  reaches  approximately  20,  or  after  the  effective  sensor  spacing 
reaches  approximately  35,  the  errors  and  the  standard  deviations  decrease  at  much 
slower  rate.    At  this  point  the  receiving  ship  has  completed  two  legs  of  the  search 
path,  and  spans  enough  of  the  two  dimensional  search    path  to  form  a  decent  estimate 
of  the  acoustic  beacon's  position. 
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4.3.2    Scenario  2  -  Stationary  Acoustic  Beacon  Located  at  0  =  [0  866  -2000]T 

Figures  4-19  through  4-26  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-27 
through  4-34  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  2.    Like  scenario  1,  as  the  number  of 
experiment  vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the 
accuracy  of  the  estimated  beacon  position  improves,  and  the  standard  deviation  of  the 
estimated  position  decreases.    Also  like  scenario  1,  as  the  effective  sensor  spacing 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  and  the  standard 
deviation  of  the  estimated  position  decreases.    Again  we  see  an  initial  rapid  decrease 
in  the  errors  and  standard  deviations  which  levels  off  after  the  number  of  experiment 
vectors  used  reaches  approximately  20,  or  the  effective  sensor  spacing  reaches 
approximately  35.    As  in  scenario  1,  these  values  correspond  to  when  the  receiving 
ship  completes  the  second  leg  of  the  search  path. 

Unlike  scenario  1,  we  see  a  significant  improvement  in  the  estimated  position 
(especially  when  using  25  meter  GPS  errors)  when  the  number  of  experiment  vectors 
used  is  greater  then    40,  or  the  effective  sensor  spacing  is  greater  then  65.     At  this 
point  the  receiving  ship  passes  directly  over  the  acoustic  beacon  and  begins  moving 
away  from  the  beacon  on  the  fourth  leg  of  the  search  path.   To  see  why  we  get  this 
improvement,  we  can  define  a  vertical  plane  as  the  plane  orthogonal  to  the  x-y  plane 
that  passes  through  the  acoustic  beacon's  position  and  the  starting  point  of  the  leg  of 
the  search  path  that  the  receiving  ship  is  currently  on.    In  general,  it  was  found  that  if 
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the  receiving  ship  moves  such  that  it  stays  in  this  vertical  plane,  significant 
improvements  to  the  estimated  beacon  location  can  be  made.    This  is  because  as  the 
receiving  ship  moves  in  the  same  vertical  plane  relative  to  the  acoustic  beacon,  the 
localization  problem  is  essentially  a  two  dimensional  problem,  and  the  range 
differences  between  measurement  vectors  is  maximized  for  a  given  ship's  velocity. 
The  same  is  true  if  the  acoustic  beacon  and  the  receiving  ship  are  in  the  same 
horizontal  plane. 
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43.3    Scenario  3  -  Stationary  Acoustic  Beacon  Located  at  0  =  [-1000  1000  -2000J1 

Figures  4-35  through  4-42  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-43 
through  4-50  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacing  for  scenario  3.    Like  the  first  two  scenarios,  as  the 
number  of  experiment  vectors  used  in  the  maximum  likelihood  estimation  problem 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  while  the  standard 
deviation  of  the  estimated  position  decreases.    Also,  as  the  effective  sensor  spacing 
increases,  the  accuracy  of  the  estimated  beacon  position  improves,  while  the  standard 
deviation  of  the  estimated  position  decreases.    Again  we  see  an  initial  rapid  decrease 
in  the  errors  and  standard  deviations  which  levels  off  after  the  number  of  experiment 
vectors  used  reaches  approximately  20,  and  the  effective  sensor  spacing  reaches 
approximately  35.    As  in  the  first  two  scenarios,  these  values  correspond  to  when  the 
receiving  ship  completes  the  second  leg  of  the  search  path. 

In  this  scenario,  we  see  a  significant  improvement  in  the  location  estimate 
when  the  number  of  experiment  vectors  used  is  greater  then  45,  or  when  the  effective 
element  spacing  is  greater  then  75.    At  this  point  the  receiving  ship  passes  through  the 
closest  point  of  approach  to  the  acoustic  beacon  on  the  fifth  leg  of  the  search  path.    In 
general,  it  was  found  that  the  estimate  of  the  acoustic  beacon's  location  improves  as 
the  receiving  ship  passes  through  closest  points  of  approach  to  the  acoustic  beacon 
along  the  search  path. 
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4.3.4    Stationary  Acoustic  Beacon  Summary 

From  scenarios  1  through  3  we  showed  that  as  the  number  of  experiment 
vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the  accuracy  of 
the  estimated  beacon  position  improves,  while  the  standard  deviation  of  the  estimated 
position  decreases.    Also,  as  the  effective  sensor  spacing  increases,  the  accuracy  of  the 
estimated  beacon  position  improves,  while  the  standard  deviation  of  the  estimated 
position  decreases.    We  also  showed  that  as  the  receiving  ship  passes  through  a  closest 
point  of  approach,  the  estimated  position  of  the  acoustic  beacon   improves.    This  is 
why  the  estimate  of  acoustic  beacon's  location  in  scenario  1  is  better  then  the  estimates 
obtained  for  the  other  two  scenarios.    In  scenario  1,  each  leg  of  the  search  path  passes 
through  a  closest  point  of  approach.    This  is  not  true  for  the  other  two  scenarios.    In 
all  of  the  scenarios,  we  see  that  the  depth  of  the  acoustic  beacon  is  the  least  accurately 
estimated  parameter.   This  is  because  we  are  attempting  to  locate  the  acoustic  beacon 
in  three  dimensions,  while  the  receiving  ship  only  moves  in  two  dimensions.    Finally, 
we  see  that  the  accuracy  of  the  estimated  acoustic  beacon  position  obtained  from  using 
GPS  errors  of  3  meters  is  approximately  an  order  of  magnitude  better  then  the 
estimated  acoustic  beacon  position  obtained  from  using  GPS  errors  of  25  meters. 

These  observations  suggest  that  to  obtain  the  best  possible  estimate  of  the 
acoustic  beacon's  location,  we  need  to  use  a  large  number  of  experiment  vectors  with  a 
large  effective  sensor  separation,  and  we  need  to  use  a  Differential/P  code  GPS 
receiver.   The  problem  with  this  is  that  the  time  it  takes  to  collect  the  measurement 
vectors  used  to  form  the  experiment  vectors  increases  with  increasing  sensor  spacing 
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and  increasing  numbers  of  experiment  vectors.    As  an  example,  with  an  effective 
sensor  spacing  of  45  pulse  repetition  intervals,  a  pulse  repetition  interval  of  2  seconds, 
and  using  50  experiment  vectors  it  takes  over  76  minutes  to  collect  the  required 
measurement  vectors.    If  time  is  an  issue,  then  we  must  use  fewer  experiment  vectors 
and  shorter  effective  sensor  spacings.    From  looking  at  the  results  of  the  simulations 
presented  above,  for  the  hexagonal  search  path  of  figure  4-1  and  for  a  pulse  repetition 
interval  of  2  seconds,  the  minimum  required  number  of  experiment  vectors  is  20,  and 
the  minimum  effective  sensor  spacing  is  35.    With  these  values  we  span  enough  of  the 
two  dimensional  search  path  to  obtain  a  decent  estimate  of  the  acoustic  beacon's 
location. 
4.4    Moving  Acoustic  Beacon 

In  this  section  we  examine  the  performance  of  the  algorithm  given  in  Figure 
3-1.    Figures  4-51  through  4-146  contain  the  results  of  the  Monte  Carlo  simulations 
conducted  for  scenarios  4  through  6.    For  each  scenario,  the  initial  value  of  the 
estimated  parameter  vector  0*  is  taken  as: 

6*  =  [  0    0    -2500    0    0    0  ]T  <4"7) 

The  feasible  region  is  defined  by  Rangemax  =  Depthmax  =  5000  meters,  and  vxmax  = 
vymax  =  Vzmax  =  5  meters  per  second.   If  the  maximum  likelihood  estimate  found  using 
the  algorithm  of  chapter  III  is  outside  the  feasible  region,  the  corresponding  entries  are 
left  blank.    To  find  a  solution  for  these  cases,  we  need  to  start  with  a  different  initial 
parameter  vector  0,  or  use  more  experiment  vectors. 

To  test  the  effect  of  increasing  the  number  of  experiment  vectors  (n),  we  solve 
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for  the  estimated  parameter  vector  0*  using  n  ranging  from  10  to  50.    We  fix  the 
effective  sensor  spacing  at  60  pulse  repetition  intervals  by  using  every  60th  received 
beacon  signal  in  defining  the  experiment  vectors.    To  test  the  effect  of  increasing  the 
effective  sensor  spacing,  we  solve  for  the  estimated  position  vector  using  effective 
sensor  spacings  ranging  from  2  to  90  pulse  repetition  intervals.    For  this  case  we  fix 
the  number  of  experiment  vectors  used  to  30.  We  conduct  each  experiment  using  GPS 
errors  of  3  meters  rms  and  25  meters  rms.    The  results  of  the  estimation  algorithm  for 
GPS  errors  of  3  meters  rms  are  shown  by  x's  on  the  plots,  while  the  results  of  the 
estimation  algorithm  for  GPS  errors  of  25  meters  rms  is  shown  by  o's. 
4.4.1    Scenario  4  -  Moving  Acoustic  Beacon  Located  at: 

0  =  [0  0  -2000  0.5  -0.5  0.251T 

Figures  4-51  through  4-66  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-67 
through  4-82  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  4.    Similar  to  the  stationary  acoustic 
beacon  scenarios,  we  see  that  as  the  number  of  experiment  vectors  used  in  the 
maximum  likelihood  estimation  problem  increases,  the  accuracy  of  the  estimated 
position  and  velocities  of  the  acoustic  beacon  improves,  while  the  standard  deviation 
of  the  estimated  position  and  velocities  decrease.    We  also  see  that  as  the  effective 
sensor  spacing  increases,  the  accuracy  of  the  estimated  position  and  velocities  of  the 
acoustic  beacon  improves,  and  the  standard  deviation  of  the  estimated  position 
decreases.    As  with  the  stationary  acoustic  beacon,  the  position  and  velocity  errors 
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initially  decrease  rapidly,  however,  after  the  number  of  experiment  vectors  used 
reaches  approximately  30,  or  the  effective  sensor  spacing  reaches  approximately  45, 
the  errors  and  the  standard  deviations  decrease  much  slower. 

Figures  4-61  through  4-66  and  figures  4-77  through  4-82  show  the  estimation 
algorithm's  ability  to  track  the  linearly  moving  acoustic  beacon.    We  see  that  projected 
current  positions  follow  the  linearly  moving  acoustic  beacon  fairly  well  when  using  3 
meter  GPS  errors.    We  also  see  that  the  standard  deviation  of  the  projected  current 
positions  decrease  as  the  number  of  experiment  vectors  used  increases  and  the 
effective  sensor  spacing  increases.    However,  we  notice  in  a  few  cases  the  standard 
deviations  increase  slightly  for  increasing  numbers  of  experiment  vectors  used  and 
increasing  effective  sensor  spacing.    This  is  a  result  of  projecting  the  current  position 
forward  in  time  using  equation  3-19. 
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4.4.2    Scenario  5  -  Moving  Acoustic  Beacon  Located  at: 
9  =  [0  866  -2000  0.5  -0.5  0.25)T 

Figures  4-83  through  4-98  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-99 
through  4-114  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  5.    Similar  to  the  previous  scenarios, 
we  see  that  as  the  number  of  experiment  vectors  used  in  the  maximum  likelihood 
estimation  problem  increases,  the  accuracy  of  the  estimated  position  and  velocities  of 
the  acoustic  beacon  improves,  while  the  standard  deviation  of  the  estimated  position 
and  velocities  decrease.    We  also  see  that  as  the  effective  sensor  spacing  increases,  the 
accuracy  of  the  estimated  position  and  velocities  of  the  acoustic  beacon  improves,  and 
the  standard  deviation  of  the  estimated  position  decreases.    As  before,  the  position  and 
velocity  errors  initially  decrease  rapidly,  however  after  the  number  of  experiment 
vectors  used  reaches  approximately  30,  and  the  effective  sensor  spacing  reaches 
approximately  45,  the  errors  and  the  standard  deviations  decrease  much  slower. 

Figures  4-93  through  4-98  and  figures  4-109  through  4-114  show  the  estimation 
algorithm's  ability  to  track  the  linearly  moving  acoustic  beacon  for  this  scenario.    We 
see  that  the  projected  current  positions  follow  the  linearly  moving  acoustic  beacon 
fairly  well  for  both  3  meter  and  25  meter  GPS  errors.    This  is  because  the  estimated 
initial  positions  x0,  y0,  and  z0  obtained  using  25  meter  GPS  errors  were  better  in  this 
scenario  then  for  scenario  4.    In  general  this  is  not  the  case,  however  the  measurement 
errors  in  this  scenario  simply  led  to  a  better  estimate  of  the  acoustic  beacon's  position. 
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4.4.3    Scenario  6  -  Moving  Acoustic  Beacon  Located  at: 
9  =  [-10000  1000  -2000  0.5  -0.5  0.25JT 

Figures  4-115  through  4-130  show  the  results  of  the  maximum  likelihood 
estimation  algorithm  for  different  numbers  of  experiment  vectors,  and  figures  4-131 
through  4-146  show  the  results  of  the  maximum  likelihood  estimation  algorithm  for 
different  effective  sensor  spacings  for  scenario  6.    Again  we  see  that  as  the  number  of 
experiment  vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the 
accuracy  of  the  estimated  position  and  velocities  of  the  acoustic  beacon  improves,  and 
the  standard  deviation  of  the  estimated  position  and  velocities  decrease.    We  also  see 
that  as  the  effective  sensor  spacing  increases,  the  accuracy  of  the  estimated  position 
and  velocities  of  the  acoustic  beacon  improves,  while  the  standard  deviation  of  the 
estimated  position  decreases.    As  before,  the  position  and  velocity  errors  initially 
decrease  rapidly,  however  after  the  number  of  experiment  vectors  used  reaches 
approximately  30,  or  the  effective  sensor  spacing  reaches  approximately  45,  the  errors 
and  the  standard  deviations  decrease  much  slower. 

Figures  4-125  through  4-130  and  figures  4-141  through  4-146  show  the 
estimation  algorithm's  ability  to  track  the  linearly  moving  acoustic  beacon  for  this 
scenario.    We  see  that  the  projected  current  positions  follow  the  linearly  moving 
acoustic  beacon  fairly  well  using  3  meter  GPS  errors.    Again,  because  of  the  errors  in 
estimating  the  acoustic  beacon's  initial  positions  x0,  y0,  and  zOJ  the  projected  current 
position  obtained  from  using  25  meter  GPS  errors  does  not  track  the  acoustic  beacon's 
motion  as  well. 
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4.4.4    Moving  Acoustic  Beacon  Summary 

From  scenarios  4  through  6  we  showed  that  as  the  number  of  experiment 
vectors  used  in  the  maximum  likelihood  estimation  problem  increases,  the  accuracy  of 
the  estimated  position  and  velocities  of  the  acoustic  beacon  improves,  while  the 
standard  deviation  of  the  estimated  position  decreases.    Also,  as  the  effective  sensor 
spacing  increases,  the  accuracy  of  the  estimated  position  and  velocities  of  the  acoustic 
beacon  improves,  and  the  standard  deviation  of  the  estimated  position  decreases.    For 
all  of  the  moving  acoustic  beacon  scenarios,  we  see  that  the  depth  of  the  acoustic 
beacon  is  the  least  accurately  estimated  parameter.   This  is  because  we  are  still 
attempting  to  locate  the  acoustic  beacon  in  three  dimensions,  while  the  receiving  ship 
only  moves  in  two  dimensions.    We  also  note  that  the  standard  deviations  of  the 
estimated  beacon  position  are  significantly  larger  for  the  moving  beacon  scenarios  then 
for  the  stationary  beacon  scenarios.    These  larger  standard  deviations  are  due  to  the 
nature  of  the  structural  model  and  reflect  the  difficulties  in  locating  a  moving  acoustic 
beacon  using  only  a  single  omnidirectional  hydrophone  as  a  receiving  source. 

Similar  to  the  stationary  acoustic  beacon  scenarios,  to  obtain  the  best  possible 
estimate  of  the  acoustic  beacon's  location  we  need  to  use  a  large  number  of  experiment 
vectors  with  a  large  effective  sensor  spacing.    Again  we  run  into  problems  with  the 
time  it  takes  to  collect  the  required  measurement  vectors.   For  example,  with  an 
effective  sensor  spacing  of  60  pulse  repetition  intervals,  a  pulse  repetition  interval  of  2 
seconds,  and  using  50  experiment  vectors  it  takes  100  minutes  to  collect  the  required 
measurement  vectors.    As  with  the  stationary  acoustic  beacon  scenarios,  if  time  is  an 
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issue,    we  must  reduce  the  number  of  experiment  vectors  used,  and  reduce  the 
effective  sensor  spacing.    As  a  minimum,  we  must  use  at  least  30  experiment  vectors 
and  a  minimum  effective  sensor  spacing  of  45  pulse  repetition  intervals.    With  these 
values,  for  the  search  path  of  figure  4-1  and  for  a  pulse  repetition  interval  of  2 
seconds,  we  should  be  able  to  obtain  a  decent  estimate  of  the  acoustic  beacon's 
position  and  velocities. 
4.5    Summary 

From  the  results  of  the  Monte  Carlo  simulations  we  see  that  in  general,  as  the 
number  of  experiment  vectors  used  to  find  the  estimated  parameter  vector  0  increases, 
the  errors  of  the  estimated  parameters  and  the  variance  of  the  estimated  parameter 
vector  deceases.    This  implied  that  to  obtain  the  best  estimate  of  the  acoustic  beacon's 
location,  we  should  use  a  large  number  of  experiment  vectors,  with  a  large  effective 
sensor  spacing.    We  run  into  problems  with  this  is  approach  if  the  time  it  takes  to 
obtain  an  estimated  position  is  a  factor.    We  showed  that  for  the  search  path  given  in 
section  4.2  and  for  an  acoustic  beacon  with  a  pulse  repetition  interval  of  2  seconds,  we 
need  to  use  a  minimum  of  20  experiment  vectors  and  an  effective  sensor  spacing  of  35 
pulse  repetition  intervals  to  obtain  a  decent  estimate  when  using  the  stationary  acoustic 
beacon  algorithm.   We  also  showed  that  with  the  same  search  path  and  pulse  repetition 
interval,  we  need  to  use  a  minimum  of  30  experiment  vectors  and   an  effective  sensor 
spacing  of  45  pulse  repetition  intervals.   In  all  scenarios,  the  use  of  accurate 
navigational  equipment  to  measure  the  position  of  the  receiving  ship  is  critical  to 
obtain  an  accurate  estimate  of  the  acoustic  beacon's  location.    This  is  shown  by  the 
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better  estimates  obtained  from  using  Differential/P  code  GPS  errors  of  3  meters  rms. 
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Chapter  V 
Receiver  Design 
5.1    Introduction 

A  receiver  must  be  designed  to  implement  the  maximum  likelihood  estimation 
algorithms  described  in  chapters  II  and  III.    This  receiver  should  fulfill  the  goals  of 
being  an  inexpensive,    lightweight,  easily  transported  receiver  that  can  perform  all  of 
the  functions  of  an  older  chart  recorder.     To  determine  the  specifications  for  the 
receiver  hardware,  we  look  at  the  signal  that  is  received,  the  ambient  noise  that  is 
received,  the  thermal  noise  generated  by  the  receiver's  preamplifier,  and  the  required 
signal  output.    We  also  examine  the  characteristics  of  the  hydrophone  used  as  a 
receiving  sensor,  and  develop  a  practical  hydrophone  model  so  the  preamplifier's  input 
characteristics  can  be  determined. 

In  designing  a  receiver  to  implement  the  algorithms  described  in  chapters  II 
and  III,  we  make  the  following  general  assumptions.    We  assume  that  the  beacon 
signal  has  a  carrier  frequency  of  10,000  Hertz,  a  pulse  width  of  10  milliseconds,  and  a 
pulse  repetition  interval  of  2  seconds.    This  is  similar  to  several  acoustic  beacons 
currently  in  use.    To  cut  costs,  a  Motorola  68HC11  microcontroller  will  be  used.    The 
68HC11  is  an  8-bit,  low  power   microcontroller  with  several  useful  peripheral 
functions  built  in.   These  peripheral  functions  include  an  eight  channel  8-bit  analog  to 
digital  (A/D)  converter,  an  asynchronous  serial  communications  interface,  five  general 
input/output  ports,  and  a  16-bit  free  running  timer  system  with  five  output  compare 
registers.    This  lets  us  use  a  single  chip  to  synchronize  the  time  of  receipt  tM  to  the 
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pulse  repetition  interval,  digitally  sample  the  received  signal,  control  the  receiver's 
gain,  and  communicate  with  the  interfacing  computer.    Another  factor  in  deciding  to 
use  the  68HC11  microcontroller  is  that  the  68HC11  and  it's  programming  support 
equipment  are  commonly  available.    For  the  receiving  sensor,  we  use  the  Benthos 
AQ-4  hydrophone  attached  to  100  meters  of  RG-58/u  coaxial  cable.    The  Benthos 
AQ-4  hydrophone  has  an  open  circuit  response  of -201  dB  re  1  Volt  per  luPa,  which 
is  representative  of  the  type  of  omnidirectional  hydrophones  currently  available. 
5.2    Design  Criterion 

The  signal  transmitted  by  the  acoustic  beacon  can  be  characterized  as  a 
sequence  of  gated  continuous  wave  pulses  at  a  carrier  frequency^.     We  depict  the 
beacon  signal  as: 

*„(0  =  J2">(t-iTp-Toycos[2nfc(t-iTp-Toy4>]  (5-1) 

i=0 

where  w(t)  is  a  windowing  function  that  defines  the  pulse  width,  Tp  is  the  period 
which  defines  the  pulse  repetition  interval,  and  <f>  is  a  phase  term.  As  before,  the 
coefficient  T0  represents  the  unknown  absolute  time  reference. 

We  can  represent  the  signal  that  is  received  by  the  observer  as: 

*„(')    "  EWf-lT;-^),C0Sf2^-'T;-^)+*+  CJ  +  n(t)         (5'2) 
i=0 

where  hx  represents  the  attenuation  the  signal  experiences  in  traveling  from  the  beacon 
to  the  observer,   and  Q  represents  a  random  phase  distortion  due  the  propagation  of 
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the  signal  through  the  ocean.    As  discussed  in  chapter  II,  the  term  tSM  represents  the 
synchronized  time  of  receipt  and  is  given  by: 

t      =  t    -  i-T    =  TD  +  T  (5-3) 

where  TR  is  the  acoustic  travel  time  of  the  beacon  signal.    The  term  «(t)  represents 
the  combination  of  the  ambient  noise  that  is  received  and  the  thermal  noise  that  is 
generated  by  the  receiver's  preamplifier. 

Since  we  use  range  differences  in  the  maximum  likelihood  estimation 
algorithms  of  chapters  II  and  III,  the  parameter  that  we  need  to  find  from  the  received 
signal  is  the  synchronized  time  of  receipt  tS(1.    In  order  to  find  tS(J,  we  digitally  process 
the  received  signal.   To  determine  the  proper  sampling  rate,  we  must  look  at  the 
frequency  content  of  the  received  signal  and  the  desired  accuracy  of  the  synchronized 
time  of  receipt  tSM.    If  we  apply  the  Nyquist  sampling  rate  theorem  directly  to  the 
received  signal,  the  sampling  rate  would  have  to  be  greater  then  twice  the  carrier 
frequency^.    For  carrier  frequencies  around  10,000  Hertz,  the  required  sampling  rate 
is  too  fast  for  the  68HC11  to  handle  both  the  data  collection  and  the  signal  processing. 
However,  from  looking  at  equation  (5-2),  we  notice  that  the  received  windowing 
function  w(t)  contains  the  parameter  tS(J.    Therefore,  if  we  remove  the  carrier  frequency 
and  just  look  at  the  envelope  of  the  received  signal  given  by  w(t),  we  can  still 
determine  the  synchronized  time  of  receipt  by  observing  when  the  signal's  envelope  is 
received.    To  remove  the  carrier  frequency /c,  we  use  a  precision  rectifying   circuit 
with  a  low  pass  filter  to  form  an  envelope  detector.    This  allows  us  sample  at  the 
reduced  rate  of  twice  the  bandwidth  of  the  signal's  envelope  given  by  w(t). 
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To  reduce  the  receiver's  overall  noise  level,  the  bandwidth  of  the  receiver 
should  match  the  bandwidth  of  the  envelope.    If  the  bandwidth  of  the  receiver 
increases  above  the  bandwidth  of  the  received  signal's  envelope,  out  of  band  noise 
from  the  oceanic  environment  and  other  interference  sources  enters  the  receiver, 
decreasing  the  signal  to  noise  ratio.    On  the  other  hand,  if  the  receiver's  bandwidth  is 
less  then  the  bandwidth  of  the  received  signal's  envelope,  we  do  not  allow  the  full 
bandwidth  of  the  envelope  to  pass  through  the  receiver,  which  again  lowers  the  signal 
to  noise  ratio.    The  windowing  function  w(t)  can  be  approximated  by  a  simple 
rectangular  window  with  a  duration  equal  to  the  pulse  width  of  the  signal.    The 
bandwidth  of  the  windowing  function  and  the  receiver  is  then  given  by: 

Bandwidth  =  l- (5-4) 

PulseWidth 

For  a  pulse  width  of  10  milliseconds,  the  windowing  function's  bandwidth  is  100 

Hertz.    With  a  bandwidth  of  100  Hertz,  the  sampling  frequency  must  then  be  at  least 

200  Hertz,  which  equates  to  a  sampling  interval  of  no  more  then  5  milliseconds. 

We  must  be  careful  not  to  sample  at  too  slow  a  rate,  otherwise  the  errors 

associated  with  the  quantization  of  the  time  base  will  cause  large  errors  in  the 

localization  algorithms.   To  determine  an  acceptable  quantization  step  size,  or 

equivalently,  how  much  error  can  we  tolerate  in  the  time  of  receipt  data,  we  need  to 

compare  the  quantization  errors  to  the  errors  in  measuring  the  observer's  location.    The 

source  of  error  in  measuring  the  observers  position  is  due  to  errors  in  the  GPS  position 

data.    For  a  C/A-code  GPS  receiver,  the  published  rms  errors  are  on  the  order  of  25 
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meters.    Using  a  simple  homogeneous,  direct  path  propagation  model  with  the  speed  of 
sound  in  water  equal  to  1500  meters  per  second,  a  signal  takes  16.667  milliseconds  to 
travel  25  meters.    We  call  this  the  equivalent  time  error  of  the  position  error.     We 
would  like  the  errors  associated  with  the  quantization  of  the  time  base  to  be  less  than 
the  equivalent  time  error  of  the  position  errors.    Assuming  no  other  errors  in  the  time 
of  receipt,  the  maximum  error  in  measuring  the  time  of  arrival  tS(J  is  half  the  sampling 
interval.    For  a  C/A  code  GPS  receiver  the  required  sampling  interval  of  5 
milliseconds  is  much  less  then  the  equivalent  time  error  of  the  position  error,  therefore 
the  quantization  errors  are  relatively  small  compared  to  the  errors  in  measuring  the 
observer's  position.    However,  because  more  accurate   navigational  equipment  will 
most  likely  be  available  in  the  near  future,  and  because  the  68HC1 1  has  the  required 
speed,  we  will  sample  the  received  signal's  envelope  every  1  millisecond.    With  a 
sampling  interval  of  1  millisecond,  as  long  as  the  rms  errors  of  the  navigational  system 
are  greater  than  1.5    meters,  the  quantization  errors  will  be  smaller  then  the  equivalent 
time  errors  of  the  position  errors. 

To  determine  the  synchronized  time  of  receipt  tSM  from  the  sampled  envelope, 
we  pass  the  sampled  envelope  through  a  matched  filter  based  upon  w(t),  and  look  for 
the  time  that  corresponds  to  the  maximum  value  of  the  output  of  the  matched  filter. 
The  received  time  is  then  divided  modulo  the  pulse  repetition  interval  to  obtain  the 
synchronized  time  of  receipt.    The  use  of  a  matched  filter  has  two  benefits.    First,  the 
output  of  a  matched  filter  for  a  rectangular  input  signal    with  the  same  pulse  width  of 
w(t)  will  have  a  unique  maximum  peak  which  we  can  use  to  calculate  the  time  of 
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receipt.    Secondly,  a  matched  filter  produces  an  output  with  the  maximum  signal  to 
noise  ratio.    The  digital  form  of  a  matched  filter  for  a  rectangular  signal  has  the  form 
of  the  moving  average: 


1        N 
y[n]  =  — —  T  x[n-i] 


(5-5) 


For  a  pulse  width  of  10  milliseconds  and  a  sampling  rate  of  1  millisecond,  N  is  equal 
to  10.    Figures  5-1  and  5-2  show  the  output  of  the  moving  average  matched  filter  for 
an  input  that  represents  the  sampled  envelope  of  the  received  signal  with  additive 
noise.    From  figure  5-2  we  see  that  it  is  relatively  easy  to  find  the  maximum  value  of 
the  output  of  the  matched  filter.    We  do  not  have  to  worry  about  the  phase  delay  of 
the  matched  filter  because  we  compare  the  time  of  arrival  of  two  signals  relative  to 
each  other.    Since  the  phase  delay  is  the  same  for  all  received  signals,  it  does  not 
effect  the  comparison  of  the  two  arrival  times. 
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The  receiver  should  be  able  to  detect  the  target's  beacon  signal  in  the  presence 
of  the  additive  noise  term  n(t).    The  two  largest  contributors  of  noise  are  ambient 
oceanic  noise  and  thermal  noise  generated  by  the  receiver's  preamplifier.    Ambient 
oceanic  noise,   due  to  factors  such  as  wind  force,  ships,  industrial  activity, 
precipitation,  biologies,  and  others,  is  received  by  the  hydrophone  which  generates  an 
equivalent   noise  voltage.    Using  the  hydrophone's  open  circuit  response 
characteristics,  the  receiver's  bandwidth,  and  empirical  data  of  noise  spectrum  levels 
summarized  by  Wenz  [Wenz  1962],  the  equivalent  noise  voltage  of  the  oceanic  noise 
can  be  calculated  using: 


e„  =  10 


/£^f£+,og(W)) 


(5-6) 


where  Hoc  is  the  hydrophones  open  circuit  response  in  dB  re  1  Volt  per  luPa,  e0  is  the 
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ambient  oceanic  noise  in  dB  re  luPa,  and  BW  is  the  receiver's  bandwidth  in  Hertz. 
Table  5-1  shows  the  equivalent  noise  voltage  for  various  Sea  states  (Beaufort  Scale)  at 
10,000  Hertz  using  a  hydrophone  with  an  open  circuit  receiver  response  of  -201  dB  re 
1  Volt  per  luPa,  and  a  receiver  bandwidth  of  100  Hertz.    Ideally  the  noise  in  a 
receiver  should  be  dominated  by  external  noise  sources.    This  means  that  the  receiver's 
thermal  noise  should  be  less  then  the  ambient  oceanic  noise.    Since  sea  states  1  and  2 
are  not  common,  the  receiver's  thermal  noise  is  designed  to  be  less  then  the  ambient 
oceanic  noise  associated  with  sea  state  3.   This  requirement  limits  the  test  receiver's 
thermal  noise  reflected  at  the  input  of  the  preamplifier  to  be  less  then  89  nV/VHz. 


Sea  State 
(Beaufort  Scale) 

Ambient  Oceanic 

Noise 

(dB  re  luPa) 

Equivalent 
Noise  Voltage 
(nV/V  Hz) 

Total  Equivalent 

Noise  Voltage  en 

G»V) 

1 

48 

22 

0.22 

2 

56 

56 

0.56 

3 

60 

89 

0.89 

5 

68 

224 

2.24 

8 

73 

398 

3.98 

limit 

80 

891 

8.91 

Table  5-1 

Another  desirable  characteristic  of  the  receiver  is  that  it  should  have  as  large  a 
dynamic  resolution  as  possible.    A  large  dynamic  resolution  allows  the  receiver  to 
detect  a  broad  level  of  signal  amplitudes  for  a  set  gain.    Since  the  received  signal  will 
be  digitally  processed,  we  need  to  look  at  the  dynamic  resolution  of  the  A/D  converter. 
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The  dynamic  resolution  of  an  A/D  converter  is  given  by: 

Dynamic  Resolution  =  20  log10(2Wtt)  (5-7) 

For  and  8  bit  A/D  converter,  the  dynamic  resolution  is  only 

20  1og10(28)  =  48  dB  (5-8) 

This  is  not  quite  large  enough.    We  would  like  a  dynamic  resolution  that  is 
comparable  to  the  dynamic  resolution  of  the  older  paper  recorders.    This  means  we 
need  a  dynamic  resolution  of  at  least  60  dB.   To  increase  the  dynamic  resolution, 
either  a  higher  bit  A/D  converter  could  be  used,  or  a  logarithmic  compressor  can  be 
used  prior  to  digital  sampling.    Since  we  are  restricted  to  the  8  bit  A/D  converter  of 
the  68HC11,  a  logarithmic  compressor  will  be  used  to  increase  the  receiver's  dynamic 
resolution. 

Using  a  logarithmic  compressor,  the  dynamic  resolution  is  given  by: 


Dynamic  Resolution  =  20  •  log 


10 


(  V     \ 

T  sat 

,  V  . 

\      mm  ) 


(5-9) 


where  Vsat  is  the  saturation  point  of  the  logarithmic  compressor  and  Vmin  is  the 
minimum  detectable  signal  at  the  input  of  the  logarithmic  compressor.    Typically, 
logarithmic  compressors  require  an  input  signal  that  is  greater  then  2  mV.    Below  2 
mV,  the  input  current  to  the  logarithmic  compressor  becomes  comparable  to  the  bias 
current  of  the  matched  transistors  used  to  obtain  the  logarithmic  dependence,  and 
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subsequently  the  logarithmic  dependence  is  no  longer  valid  [Millman  1979].    For  the 
receiver  designed  in  section  5.4,  Vsat  is  approximately  8  V  which  gives  a  dynamic 
resolution  of: 


/ 


Dynamic  Resolution  =  20  •  log 


10 


8 


U-io-3j 


=  72  dB  (5-10) 


To  determine  the  required  gain  of  the  receiver,  we  need  to  look  at  the  signal 
level  that  we  are  attempting  to  receive.    We  wish  to  be  able  to  detect  low  level  signals 
that  are  right  at  the  noise  floor  of  the  receiver.    This  requires  the  receiver  to  have 
enough  gain  to  detect  a  signal  at  the  equivalent  oceanic  noise  level  of  89  nV/vHz. 
Since  a  logarithmic  compressor  is  used  just  prior  to  A/D  conversion,  the  required  gain 
is  determined  by  the  minimum  detectable  level  in  the  logarithmic  compressor  and  the 
oceanic  noise  level.     Using  the  ambient  oceanic  noise  and  the  input  requirements  of 
the  logarithmic  compressor  from  above,  the  maximum  required  gain  of  the  receiver  is 
given  by: 

m    2-l(T3    m  8?  dB  (5.u) 

■"      89  •  10-9 

However,  it  is  possible  that  the  received  signal  could  be  quite  a  bit  larger  then 

the  minimum  signal  level  for  a  strong  beacon  in  close  proximity  to  the  receiving  ship. 

For  example,  a  30  Watt  beacon  100  meters  from  the  receiving  hydrophone  will 

produce  an  input  signal  of  about  10  mV.     This  signal  would  completely  saturate  the 

receiver  if  the  gain  is  fixed  at  AVlT18X.    To  prevent  the  receiver  from  saturating,  some 

form  of  feedback  gain  control  is  needed.    Using  one  of  the  output  ports  of  the  68HC1 1 
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as  a  control  line,  simple  resistive  attenuators  can  be  switched  on  or  off  to  reduce  or 
increase  the  gain  of  the  receiver  based  upon  the  maximum  signal  level  at  the  A/D 
converter.    To  determine  how  much  attenuation  is  needed,  we  look  at  the  saturation 
point  of  the  preamplifier  and  the  maximum  likely  input  signal.    For  design  purposes, 
to  keep  a  10  mV  signal  from  saturating  the  receiver,  the  receiver's  minimum  gain  is 
given  by: 


"sat  8 


Av    = S_=_2_  =  58rfB  (5-12) 

■*    10-103     10-10"3 


Here  again  Vsat  is  the  logarithmic  compressor's  saturation  level.       Since  the  input 
signal  level  will  be  somewhere  between  the  noise  floor  and  the  maximum  likely  input 
signal  most  of  the  time,  we  can  use  multiple  resistive  attenuator  networks  to  set  the 
receiver's  gain  to  any  level  in  between  AVmax  and  AVmin.    For  this  design  we  will  use 
four  resistive  attenuator  networks  to  provide  attenuation  levels  of  -3  dB,  -9  dB, 
-12  dB,  -18  dB,  -24  dB,  and  -30  dB. 
5.3    Hydrophone  Model 

To  determine  the  input  characteristics  of  the  preamplifier,  the  hydrophone  and 
cable  must  be  modeled.    Figure  5-3  shows  an  equivalent  circuit  for  a  stiffness- 
controlled  piezoelectric  hydrophone.    Here  Rh  is  the  hydrophone's  resistance,  Ch  is  the 
hydrophone's  capacitance,  en  represents  the  equivalent  ambient  noise  of  the  ocean,  and 
ehn  represents  the  thermal  noise  of  the  hydrophone.   For  frequencies  considerably 
below  100  kHz,  the  ambient  noise  level  of  the  ocean  is  much  greater  then  the 
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hydrophone's  thermal  noise,  while  the  impedance  of  the  hydrophone  is  dominated  by 
the  capacitance  Ch.  This  allows  us  to  simplify  the  hydrophone  model  by  eliminating 
Rh  and  ehn  [Wilson  1985]. 
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The  cable  assembly  can  be  modeled  as  a  two  conductor  transmission  line. 
Using  standard  RG-58/u  coaxial  cable  with  a  solid  copper  inner  conductor  and  a 
polyethylene  dielectric,  we  can  model  the  cable  as  a  series  resistance  Rc  and  a  shunt 
capacitance  Cc  [Cheng  1983].     Standard  RG-58/u  coaxial  cable  has  a  series  resistance 
of  33.31  Q  per  1,000  meters,  and  shunt  capacitance  of  70  pF  per  meter.    Combing  the 
simplified  hydrophone  model  and  the  cable  model,  we  have  the  circuit  of  figure  5-  4. 


Figure  5-4 
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Figure  5-4  can  be  simplified  to  give  the  equivalent  Thevinin  circuit  model: 


z.  (/) 


e  +  e 

n  c 


V 


Figure  5-5 


i 


The  source  impedance  Zs(/)  is  given  by: 


Zs(f)  = 


2jnfReCh  +  l 


[2jnfRcChCc+(Ch+Cc)]2jnf 


(5-13) 


Figure  5-6  shows  a  plot  of  the  source  impedance  verses  frequency  for  the  Benthos 
AQ-4  hydrophone  with  Ch  specified  as  2,400  pF  ±25%.    To  prevent  serious  loading 
effects,  the  preamplifier's  input  impedance  must  be  considerably  larger  then  the  source 
impedance  given  by  equation  (5-13).    For  design  purposes,  the  magnitude  of  the 
source  impedance  at  10,000  Hertz   is  1,693  Q,  therefore  we  choose  the  preamplifier's 
input  impedance  to  be  at  a  minimum  of  20  time  the  source  impedance,  or  33.8  kQ. 
This  will  keep  the  loss  due  to  loading  below  0.5  dB. 
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Source  Impedance  Magnitude  vs  Frequency  in  Hz 


Figure  5-6 


5.4    Test  Receiver  Hardware  Design 

Based  on  these  design  criteria,  a  receiver  was  built  for  testing.    This  section 
discuses  the  circuit  design  considerations  and  implementation  of  this  test  receiver. 
Figure  7  shows  the  general  signal  flow  of  the  receiver  starting  with  the  preamplifier 
and  moving  to  the  68HC11  microcontroller.    An  important  theme  of  the  receiver 
design  is  to  avoid  exotic  components  to  minimize  the  cost  of  the  receiver. 
5.4.1    Preamplifier 

Refer  to  the  preamplifier  schematic  diagrams  in  Appendix  1  for  the  following 
description.    The  first  stage  of  the  preamplifier  is  a  tuned  N  channel  junction  field 
effect  transistor  (JFET)  common-source  amplifier.     To  help  keep  low  frequency 
ambient  oceanic  noise  from  entering  the  preamplifier,  C01  and  Rq,  form  a  high  pass 
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Figure  5-7 


filter  with  a  cutoff  frequency  given  by: 


/,= 


2  %  /^  C( 


(5-14) 


01 


To  eliminate  as  much  low  frequency  oceanic  noise  as  possible  but  still  allow  for  small 
changes  in  the  acoustic  beacon's  carrier  frequency,  we  chose  the  high  pass  filter  cut  off 
frequency  as  7000  Hertz.   The  preamplifier's  input  impedance  is  determined  by  Rq, 
since  the  input  impedance  of  the  JFET  is  so  large  (  >1014  Q. ).    To  prevent  loading 
between  the  hydrophone  source  and  the  preamplifier  we  must  ensure  Rq,  is  larger  then 
33.8  kQ.    To  ensure  that  the  thermal  noise  of  the  preamplifier  is  less  then  equivalent 
oceanic  noise  of  sea  state  3,  Rq,  must  be  chosen  such  that  the  thermal  noise  of  the 
parallel  combination  of  Rq,  and  source  impedance  Zs(/)  is  considerably  less  then 
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89   nV/VHz.    The  thermal  noise  of  a  resistor   is  given  by: 

en=j4ktRB  (5"15) 

where  k  is  Boltzmann's  constant,  t  is  the  absolute  temperature  in  Kelvin,  B  is  the 
bandwidth  in  Hertz,  and  R  is  the  resistance  in  Ohms  [Horowitz  and  Hill  1989].    For 
the  Benthos  AQ-4  hydrophone  at  a  frequency  of  10,000  Hertz  Zs(/)  is  approximately 
1700  Cl.    As  a  result,  the  parallel  combination  of  Rq,  and   Zs(/)  will  be  close  to  the 
value  of  Zs(/)  for  Rq,  greater  then  32  kQ,  and  the  associated  thermal  noise  will  be 
well  below  89   nV/VHz.    However,  it  would  be  nice  to  ensure  that  the  thermal  noise  of 
the  preamplifier  is  much  less  then  equivalent  oceanic  noise  of  sea  state  3  for  any 
source  impedance.    To  ensure  this,  we  choose  Rq,  such  that  its  thermal  noise  is 
approximately  45  nV/VHz.    To  meet  the  noise  constraint,  the  loading  constraint,  and 
the  cut  off  frequency  constrain  of  equation  (14),  we  choose  R„,  as  120  kQ  and  C0)  as 
180  pF. 

The  gain  of  the  first  stage  JFET  common-source  amplifier  is  given  by: 


A  (  f )  =      Y*'Zp(f)'rd  (5.i6) 

ZD(f)+rd 


'd 

where  Yfs  is  the  JFET's  forward  transconductance,  rd  is  the  JFET's  intrinsic  drain 
resistance,  and  ZD(/)  is  given  by: 


2jnf 


zAf)  = =^= r-  (5"17) 
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+   VlL  + 
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ZD(/)  represents  the  complex  impedance  of  the  combination  of  L01,  R^,  and  C02.    The 
use  of  the  reactive  load  ZD(/)  allows  us  to  obtain  the  narrow  bandwidth  required  by 
equation  (5-4).    The  gain  of  the  first  stage  will  be  greatest  when  the  frequency  of  the 
input  signal  is  at  the  resonant  frequency  of  ZD(/).    The  resonant  frequency  of  ZD(/) 
is  given  by: 

fr   =  /  (5-18) 

We  want  the  preamplifier  to  have  it's  maximum  gain  at  the  acoustic  beacon's  carrier 
frequency,  therefore  we  choose  L01  and  C02  such  that  the  resonant  frequency  equals  the 
acoustic  beacon's  carrier  frequency  .    In  the  test  receiver,  Q01  is  an  E230  general 
purpose  N  channel  JFET.   The  E230  has  a  nominal  forward  transconductance  of 
1.5-10"3  Siemens  and  a  nominal  intrinsic  drain  resistance  of  12.5  kQ.    Using  equations 
(5-16)  and  (5-17),  and  the  values  from  Appendix  1,  at  a  beacon  frequency  of  10,000 
Hz,  AV1  is  approximately  24  dB. 

In  general,  the  output  impedance  of  an  R-L-C  tuned  amplifier  is  quite  high, 
therefore,  a   JFET  source  follower  is  used  as  a  buffer  immediately  following  the  first 
stage.     Resistor  R^  and  capacitor  C04  form  a  high  pass  filter  similar  to  Rq,  and  C01, 
and  serve  to  capacitively  couple  the  JFET  source  follower  to  the  tuned  JFET  amplifier. 
The  cut  off  frequency  of  the  high  pass  filter  formed  by  R^  and  C04   is  given  by 
equation  (5-14)  with  R^  substituted  for  Rq,  and  C04  substituted  for  C01.    To  prevent 
loading  between  the  JFET  amplifier  and  the  JFET  buffer,  R^  must  be  significantly 
larger  then  the  output  impedance  of  the  JFET  amplifier.    However,  we  must  be  careful 
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in  choosing  Rq4  so  that  its  thermal  noise,  when  reflected  back  to  the  input  of  the  first 
stage,  is  less  then  89  nV/V  Hz.    Using  equation  (15),  this  limits  R^  to  560  kQ. 

To  enhance  the  performance  of  the  JFET  source  follower,    Q03  and  R^  are 
added  as  a  bootstrapped  load.     Because  the  base-emitter  voltage  of  Q03  is 
approximately  constant,  the  combination  of  R^  and  Q03  cause  a  constant  source  current 
to  flow  through  JFET  Q02.    This  makes  Q02's  VGS  approximately  constant,  which  in 
return  reduces  nonlinearities  [Horowitz  and  Hill  1989].    This  is  beneficial  because  the 
signal  level  at  this  point  in  the  preamplifier  is  still  quite  small. 

The  first  stage  of  the  preamplifier  is  powered  by  a  separate  5  Volt  3-terminal 
7805  voltage  regulator.    We  do  this  to  isolate  the  first  stage  from  subsequent  stages, 
which  prevents  the  feedback  of  any  noise  generated  by  subsequent  stages  along  the 
main  power  supply  line.    This  provides  Q0,  with  a  clean,  stable  supply  voltage  which 
is  critical  when  working  with  very  low  level  input  signals. 

The  second  stage  of  the  preamplifier  is  another  tuned  amplifier,  this  time  using 
a  PNP  bipolar  transistor.    Capacitor  C05  combined  with  the  parallel  combination  of  the 
bias  resistors  R^  and  Ro8  form  another  high  pass  filter  while  also  serving  to 
capacitively  couple  the  JFET  source  follower  from  the  first  stage  to  the  second  stage. 
The  cutoff  frequency  of  the  high  pass  filter  formed  by  C05,  Rq,  and  RqZ  is  given  by: 


/.~     l 


9      r     *Q7-*o8  (5-19) 


^7  +*08 
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For  this  stage,  we  set  the  high  pass  filter's  cut  off  frequency  at  3000  Hertz.    The  gain 
of  the  second  stage  is  given  by: 


Av   =  e±L±  (5-20) 

2  R 

where 


zAf)  = ^-, r-  (5"21) 


(2/k/J2  +-2M-  +      -1— 

^11^07  ^02^07 


As  in  the  first  stage  we  set  the  resonant  frequency  of  Zc(/)  given  by: 

fr  =  " J1 (5-22) 

to  the  acoustic  beacon's  carrier  frequency.    Using  equations  (5-20)  and  (5-21)    for  a 
beacon  frequency  of  10,000  Hertz,  AV2  is  approximately  31  db. 

Following  the  PNP  tuned  amplifier,  a  simple  JFET  source  follower  is  used  as  a 
buffer.    Capacitor  Cog  and  resistor  R12  form  yet  another  high  pass  filter  while  also 
capacitively  coupling  the  output  of  the  PNP  amplifier  to  the  input  to  the  JFET 
follower.    The  cut  off  frequency  of  the  high  pass  filter  formed  by  C08  and  R12  is  given 
by  equation  (14)  with  C08  substituted  for  C01  and  R12  substituted  for  Ro,,and  is  set  to 
3,000  Hertz. 

Similar  to  the  first  stage,  the  second  gain  stage  is  powered  by  a  separate  5 
Volt,  3 -terminal  7805  voltage  regulator.    Again  we  do  this  to  prevent  noise  from  being 
feedback  along  the  power  supply  lines. 
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At  the  end  of  the  second  stage  of  the  preamplifier  the  maximum  gain  at  the 
acoustic  beacon's  carrier  frequency  is  approximately  55  dB.    We  are  under  the 
minimum  required  gain  of  58  dB,  therefore  we  should  not  have  to  worry  about  the 
first  two  stages  of  the  preamplifier  saturating  the  logarithmic  compressor.    However, 
we  still  need  an  additional  32  dB  of  gain  to  reach  the  required  maximum  gain  of  87 
dB.    Prior  to  the  next  gain  stage,  we  include  an  attenuation  network  to  prevent 
subsequent  stages  from  saturating. 

Following  the  JFET  source  follower  Q05,  R,4  in  combination  with  shunt 
resistors  R15,  R16,  R17,  and  Rlg  form  a  variable  attenuation  network  which  is  controlled 
by  the  68HC11  microcontroller.    To  reduce  the  gain  of  the  preamplifier,  any 
combination  of  R15  through  Rlg  can  be  switched  to  ground  through  two  CD4053 
analog  switches.    Once  grounded,  the  shunt  resistors  form  a  voltage  divider  with  R14, 
and  subsequently  attenuate  the  signal.    Following  the  shunt  resistors  is  a  simple 
common  emitter  amplifier  that  provides  the  final  gain  necessary  to  obtain  a  maximum 
of  87  dB.    The  gain  of  this  stage,  including  the  effects  of  the  attenuator  network  is 
given  by: 


2./1W,-' 


3         *22 


I  R..R~\ 
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*19*20    |    „  *19  ^0 


R+      "   M    Rt 


'2*fCn  +  Ra+Ru 


\  *19  +  *2<)J      *       *19  +  /?20 

where  R,.  is  the  parallel  combination  of  any  shunt  resistors  R15  through  Rlg  that  are 
switched  to  ground.    If  none  of  the  shunt  resistors  are  switched  to  ground,  R,.  is  very 
large  and  AV3  approaches: 
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A„  = 


^22 


(5-24) 


In  this  case  the  gain  of  the  preamplifier  is  at  its  maximum  of  approximately  89  dB.    In 
actuality,  the  maximum  gain  will  be  slightly  less  then  89  dB  due  to  small  losses 
caused  by  loading  between  the  different  stages.    If  all  of  the  shunt  resistors  are 
switched  to  ground,  R,  is  at  its  minimum  value  and  the  gain  of  the  preamplifier  is 
approximately  56  dB.    Table  5-2  summarizes  which  shunt  resistors  are  switched  to 
ground  to  obtain  different  levels  of  attenuation. 


Attenuation  Level 

Shunt  Resistors  Switched  to  Ground 

OdB 

none 

-3  dB 

R15 

-9  dB 

R,6 

-12  dB 

R15  and  R16 

-18  dB 

R.7 

-24  dB 

R18 

-30  dB 

R15,  R16,  R17,  and  R18 

Table  5-2 
5.4.2    Envelope  Detector  Circuit 

Refer  to  the  Envelope  Detector  schematic  diagram  in  Appendix  1  for  the 
following  description.    After  the  preamplifier,  the  received  signal  passes  through  a 
unity  gain  buffer.    This  isolates  the  preamplifier  from  the  envelope  detector,  and  also 
provides  the  low  source  impedance  that  the  precision  rectifier  circuit  needs  to  function 
properly.    U07,  Q07,  Qog,  and  the  low  pass  filter  combination  of  C25  and  R31  are  the 
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heart  of  the  envelope  detector.    Diode  D01  protects  U07  during  large  input  swings  above 
the  reference  voltage  VREF.    Resistors  R29  and  R30  add  bias  stability  to  transistors  Q07 
and  Qog. 

As  the  input  signal  at  the  inverting  terminal  of  U07  goes  below  the  reference 
voltage  at  the  noninverting  terminal  of  U07,  Q07  is  brought  into  the  active  region, 
thereby  drawing  Qog  into  the  active  region  which  charges  capacitor  C25.    As  the 
difference  between  the  reference  voltage  and  the  input  signal  becomes  greater,  Q07  and 
Qog  are  brought  further  into  the  active  region  which  in  turn  increases  the  time  that 
capacitor  C25  charges.    When  the  signal  at  the  inverting  terminal  of  U07  is  above  the 
reference  voltage  at  the  noninverting  terminal  of  U07,  transistor  Q07,  and  subsequently 
Qog  are  cut  off.    The  charge  in  capacitor  C25  is  then  discharged  through  resistor  R31. 
As  long  as  the  time  constant  formed  by  the  combination  of  C25  and  R31  is  much 
greater  then  the  period  of  the  input  signal's  carrier  frequency,  the  output  taken  at  C25 
will  be  the  envelope  of  the  input  signal.    To  ensure  operation  with  very  low  level 
inputs,  Uog  is  chosen  to  have  a  large  gain  bandwidth  product  and  a  fast  slew  rate. 
5.4.3    Logarithmic  Compressor 

Refer  to  the  Logarithmic  Compressor  schematic  diagram  in  Appendix  1  for  the 
following  description.    Prior  to  logarithmic  compression,  we  pass  the  received 
envelope  through  a  noninverting  amplifier  with  a  gain  of  9  dB  to  restore  the  signal 
level  that  was  lost  in  the  envelope  detector.   To  obtain  an  output  that  is  proportional 
the  logarithm  of  the  input,  we  rely  on  the  logarithmic  relation  between  transistor  Q09's 
voltage  and  current.    By  using  Q09  in  U09's  feedback  loop,  the  output  of  the  logarithmic 
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compressor  is  given  by: 


vTJ  v'^ 


*»-y*) 


(5-25) 


where  VT  is  given  by: 


v       temperature  (5-26) 

T  11600 

Here  the  temperature  is  in  Kelvin.    For  room  temperature,  VT  is  approximately  0.0259. 
From  equation  (5-25)  we  note  that  for  small  input  signals,  the  output  V0  is  large,  and 
for  large  input  signals,  the  output  V0  is  small.    To  set  the  zero  crossing  point  of  the 
logarithmic  compressor,  we  choose  R40  such  that: 

*  -  ^  w 

"sat 

With  R35  equal  to  10  kQ,  V+  equal  to  10  Volts,  and  Vsal  equal  to  8  Volts,  R40  is 
approximately    12.5  kQ.    Vsat  represents  the  largest  possible  input  to  the  logarithmic 
compressor.    To  set  the  maximum  output  level  of  the  logarithmic  compressor,  we 
chose  R42  and  R43  such  that  the  minimum  input  signal  of  2  mV  produces  an  output  of 
5  volts.    This  allows  us  to  digitally  sample  the  output  of  the  logarithmic  compressor 
directly,  without  worrying  about  damaging  the  68HCll's  A/D  converter.    The  use  of 
the  matched  transistor  Q09  helps  stabilize   the  temperature  dependence  of  VT,  and  is 
essential  to  eliminate  the  dependence  upon  the  reverse  saturation  current  I0  which 
doubles  for  every  10°  C  rise  in  temperature  [Millman  1979]. 

By  taking  the  saturation  level  of  the  receivers  as  approximately  8  volts,  the 
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=  72  dB  (5-28) 


dynamic  resolution  of  the  receiver  is  approximately: 

I     8     1 
Dynamic  Resolution  =  20 -log,  J 

10U-io-3; 

To  obtain  the  full  dynamic  resolution  at  the  input  to  the  A/D  converter,  the  output  of 
operational  amplifier  U10  must  be  capable  of  going  between  zero  and  five  volts.    We 
would  like  to  restrict  the  output  of  U10  to  be  strictly  less  then  5.5  Volts  to  prevent 
damage  to  the  68HCll's  A/D  converter  in  case  of  a  failure  in  the  logarithmic 
compressor.    To  accomplish  this,  we  step  down  the  main  positive  supply  voltage  to  5.6 
volts  using  a  zener  diode  reference.    The  maximum  output  of  the  CA3130  operational 
amplifier  used  for  U,0  is  about  0.5  volts  below  the  positive  supply  voltage,  therefore 
the  output  of  U10  is  restricted  between  0  and  5.1  volts. 
5.4.4   68HC11  Microcontroller 

Refer  to  the  68HC11  Microcontroller  schematic  diagram  in  Appendix  1  for  the 
following  description.   The  68HC11  is  run  in  expanded  mode  at  a  clock  speed  of 
8  MHz.    Input/Output  ports  B  and  C  are  used  to  interface  to  the  external  27HC64 
EPROM  and  the  62HC64  RAM  chips.    A  74HC373  multiplexer  and  a  74HC00  NAND 
GATE  are  used  to  form  the  proper  address  line  controls  and  to  transfer  data  to  the 
external  memory  chips.    Port  PEO  is  used  for  the  input  to  the  A/D  converter.    The 
logarithmically  compressed  signal  passes  through  a  low  pass  filter  to  remove  any  high 
frequency  noise,  and  then  is  sequentially  sampled  by  the  A/D  converter.    Ports  PDO 
and  PD1  are  used  for  serial  data  output.    A  SCL/U  20  mA  SAIL-to-low-power-logic 
converter  is  used  to  convert  the  68HC1  l's  serial  data  to  the  SAIL  communication 
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protocol.    The  use  of  the  SAIL  communications  protocol  is  beneficial  because  of  it's 
simplicity,  and  it's  ability  to  communicate  with  multiple  nodes.   The  rest  of  port  D's 
output  lines  are  tied  to  the  positive  supply  through  100  kQ  pull  up  resistors  to  prevent 
the  output  lines  from  floating.    Ports  PA3,  PA4,  PA5,  and  PA7  are  used  to  control  the 
two  CD4053  2  channel  analog  switches  which  control  the  attenuator  network  described 
earlier.    The  rest  of  port  A's  input/output  lines,  except  PAO,  are  tied  to  ground  through 
100  kQ  resistors  to  prevent  the  outputs  from  floating.    PAO  is  left  as  an  external  input 
for  further  development,  and  is  tied  to  the  positive  supply  through  a  100  kQ.  pull  up 
resistor. 

Appendix  2  contains  a  listing  of  the  program  that  the  68HC11  executes. 
5.4.5    Power  Supply 

In  the  test  receiver,  a  +10  volt  power  supply  is  used  to  power  the  preamplifier, 
the  envelope  detector,  and  the  logarithmic  compressor.    A  secondary  +5  volt  power 
supply  is  used  to  power  the  68HC1 1  microcontroller.    The  use  of  a  separate  power 
supply  for  the  microcontroller  prevents  high  frequency  noise  generated  by  the  digital 
components  from  entering  the  preamplifier.    For  the  -5  V  that  is  required  by  the 
logarithmic  compressor,  a  third  supply  is  used.     This  provides  a  better  regulated 
negative  supply  then  using  a  DC  to  DC  voltage  converter  such  as  the  ICL  7660  to 
generate  the  required  -5  V.   Finally,  a  +12  volt,  300  mA  supply  is  provided  to  power 
an  external  GPS  receiver.    All  four  power  supplies  are  built  on  a  common  circuit 
board  and  share  a  common  ground  bus.    Refer  to  the  Power  Supply  schematic  diagram 
in  Appendix  1  for  the  following  circuit  description. 
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The  test  receiver  uses  a  standard  power  cord  to  connect  to  external  power  with 
a  one  half  amp  slow-blow  fuse  to  protect  the  receiver  in  case  of  a  short  circuit.    A 
Magnetek  Triad  F-93X  transformer  is  used  to  step  down  the  input  voltage.    Diodes  D01 
through  D04  act  as  a  standard  full  wave  bridge  rectifier.    Voltage  regulator  U01  is  a 
simple  three  terminal  +12  volt  regulator  used  to  provide  power  to  the  external  GPS 
receiver.    Capacitor  C01  filters  the  rectified  supply  voltage  to  provide  an  unregulated 
DC  voltage  to  U01.    Capacitors  C02  and  C03  are  bypass  capacitors  used  to  reduce  noise 
on  U01's  input  and  output  leads.    Because  of  the  high  current  requirements  of  the 
voltage  regulator,  U01  is  mounted  to  the  chassis  bottom  for  heat  sinking. 

Voltage  regulator  U02  is  an  adjustable  four  terminal  voltage  regulator  used  to 
provide  the  +10  volts  required  by  the  preamplifier,  absolute  value  circuit,  and  the 
logarithmic  compressor.    Resistor  R^  and  capacitor  C04  form  a  low  pass  filter  which 
helps  reduce  high  frequency  feedback  from  the  GPS  receiver  power  supply  (U0]).    Rq, 
also  acts  as  an  attenuator,  reducing  the  unregulated  DC  input  voltage  to  regulator  U02. 
By  doing  this,  the  power  that  U02  has  to  sink  is  reduced,  increasing  U02's  efficiency. 
Resistors  R^,  R^,  and  R04  form  the  feedback  network  used  by  U02  to  set  the  output 
voltage.    By  using  an  adjustable  voltage  regulator,  the  positive  supply  voltage  can  be 
set  more  precisely,  which  is  needed  to  maintain  sensitive  bias  points  in  the  logarithmic 
compressor.    Capacitors  C05  and  C06  are  bypass  capacitors  similar  to  C02  and  C03. 

Voltage  regulator  U03  is  a  simple  three  terminal  regulator  used  to  supply  the  +5 
volts  required  by  the  68HC11  and  support  systems.    Resistor  R^  and  capacitor  C07 
form  another  low  pass  filter  which  helps  isolate  the  preamplifier  from  the  68HC1 1 
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microcontroller.    As  with  Rq,,  Rq,  reduces  the  unregulated  DC  voltage  at  the  input  of 
U03,  reducing  the  power  that  U03  must  sink.    Capacitors  Cog  and  C09  are  bypass 
capacitors  similar  to  C02  and  C03.   The  combination  of  resistor  R^  and  LED  D05  are 
used  as  a  power  indicator,  with  D05  mounted  on  the  front  panel  of  the  chassis  next  to 
the  power  switch. 

Finally,  voltage  regulator  U04  is  a  four  terminal,  adjustable  negative  voltage 
regulator  that  is  used  to  provide  the  -5  volts  required  for  the  logarithmic  compressor. 
Resistor  R^  and  capacitor  C10  form  a  low  pass  filter  which  converts  the  rectified  input 
voltage  to  unregulated  DC.     Resistors  R^,  R„9,  and  R10  form  the  feedback  network 
used  by  U04  to  set  the  output  voltage  at  -5  volts.   As  before,  C,,  and  C12  are  bypass 
capacitors  that  help  reduce  noise   the  voltage  regulator's  input  and  output  lines. 
5.5   Test  Receiver  Performance 

To  test  the  validity  of  the  receiver  designed  in  section  5.4,  experiments  were 
conducted  to  measure  the  actual  performance  of  the  preamplifier,  envelope  detector, 
and  logarithmic  compressor. 
5.5.1    Preamplifier  Performance 

To  test  the  performance  of  the  preamplifier,  experiments  were  conducted  to 
measure  the  preamplifier's  actual  gain,  bandwidth,  and  thermal  noise.   To  measure  the 
gain  and  bandwidth  of  the  preamplifier,  the  output  of  the  preamplifier  was  measured 
for  sinusoidal  inputs  at  different  frequencies.   The  results,  along  with  the  predicted 
values  are  plotted  in  figure  5-8.   From  figure  5-8  we  see  that  the  actual  gain  of  the 
preamplifier  at  the  acoustic  beacon's  carrier  frequency  is  86  dB.   This  is  close  enough 
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Figure  5-8 


to  the  design  goal  to  be  acceptable.    The  loss  in  gain  compared  to  the  predicted  gain  is 
due  to  the  effects  of  loading  between  the  various  stages  and  to  deviations  from  the 
nominal  values  of  Yfs  and  rd.    We  also  note  that  the  actual  bandwidth  is  120  Hz  which 
is  slightly  larger  then  the  predicted  bandwidth.    This  increase  is  due  to  deviations  of 
Ro2  and  Rn  from  their  nominal  values  and  is  not  significant. 

To  determine  the  actual  thermal  noise  of  the  preamplifier,  we  short  the 
preamplifier's  input  and  measure  the  root  mean  square  output  using  a  digital 
multimeter.    Assuming  the  preamplifier's  noise  is  normally  distributed,  we  correct  the 
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output  measurement  to  reflect  a  normal  distribution  by  multiplying  by  1.13  [Horowitz 
and  Hill  1989].    The  preamplifier's  thermal  noise  is  then  found  by  using: 


1.13  -e. 

en  =  -—±  (5-29) 

AVJBW 


where  es  is  the  measured  output  voltage,  Av  is  the  total  gain  of  the  preamplifier,  and 
BW  is  the  bandwidth  of  the  preamplifier.    Using  this  approach,  es  was  measured  as 
6.8  millivolts.    The  preamplifier's  thermal  noise  is  then: 

en  «   113-6.8  1Q-3  m  31  nVlyfjfz  (5.30) 

19275  /120 

To  check  this  value  we  can  observe  the  output  of  the  preamplifier  (with  the  input 

grounded)  on  an  oscilloscope.    To  measure  the  preamplifier's  noise,  we  take  the  peak 

value  observed  on  the  oscilloscope.    Next  we  calculate  the  preamplifier's  thermal  noise 

using: 


en  =  %^  (5-31) 

AV/BW 


This  gives  a  rough  approximation  of  the  thermal  noise  of  the  preamplifier.    Vpeak  was 
measured  as  35  mV.    Using  equation  (5-31),  the  thermal  noise  of  the  preamplifier  is 
roughly  28  nV/VHz.    This  value  is  of  the  same  order  of  magnitude  as  found  in 
equation  (5-30),  so  we  can  assume  the  noise  figure  given  in  equation  (5-30)  is  correct. 
5.5.2    Envelope  Detector 

To  test  the  performance  of  the  envelope  detector  we  look  at  the  output  for 
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different  amplitudes  of  a  sinusoidal  input.    Figure  5-9  shows  the  measured  output  of 
the  envelope  detector  for  different  amplitudes  of  a  10,000  Hertz  sinusoid  input. 


o.oi  - 


Measured  Output  (Volts)  vs  Input  (Volts) 
Predicted  Linear  Relation 


Figure  5-9 


Ideally,  the  envelope  detector  should  have  an  output  that  is  linearly  dependent  on  the 
amplitude  of  the  input  sinusoid.    This  allows  the  envelope  detector  to  accurately  track 
the  true  envelope  of  the  beacon  signal.    From  figure  5-9  we  see  that  the  measured 
output  is  nearly  linear,  therefore  we  expect  the  envelope  detector  to  work  properly. 
5.5.3    Logarithmic  Compressor 

To  test  the  performance  of  the  logarithmic  compressor,  we  look  at  the  output 
for  different  DC  voltage  inputs.  Figure  5-10  shows  the  measured  output  values  and 
the  predicted  values. 
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Measured  Output  (Volts)  vs  Input  (Volts) 
Predicted  Output 


Figure  5-10 


From  figure  10  we  see  that  the  logarithmic  compressor  does  not  follow  an  exact 
logarithmic  relation.    However,  since  the  output  of  the  logarithmic  compressor 
monotonically  decreases  throughout  the  full  range  of  input  values,  the  compressor  is 
sufficiently  logarithmic  to  achieve  the  dynamic  resolution  of  equation  (5-28).    Since 
we  achieve  the  desired  dynamic  resolution,  the  performance  of  the  logarithmic 
compressor  is  acceptable. 
5.6  Conclusions 

In  this  chapter  a  receiver  to  implement  the  maximum  likelihood  estimation 
algorithms  developed  in  chapter  II  and  III  was  designed  and  tested.     Appendix  1 
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contains  the  schematic  diagrams  of  the  receiver  built  for  testing.    From  the  tests 
conducted,  we  see  that  the  test  receiver  meets  the  design  criteria  developed  in  section 
5.2.    To  complete  the  receiver,  an  Apple  Macintosh  personal  computer  is  used  for  the 
final  signal  processing  and  for  data  display.    Appendix  3  contains  a  listing  of  the 
source  code  used  by  the  Macintosh  for  signal  processing  and  for  displaying  the 
collected  data. 
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Chapter  VI 
Conclusion 
6.1    Observations  and  Summary 

In  this  thesis,  a  method  to  passively  localize  stationary  and  linearly  moving 
acoustic  beacons  was  developed.    Because  of  the  nonlinearities  of  the  structural  model 
g(w^  0),  and  the  errors  in  the  measurements  xp,  y^,  and  tSM,  the  localization  problem 
was  formulated  as  a  constrained  maximum  likelihood  estimation  problem.    To  solve 
for  the  maximum  likelihood  estimate,  a  vector  of  Lagrange  multipliers  was  introduced 
and  a  Lagrangian  function  A  formed.   The  maximum  likelihood  estimate  was  then 
found  at  the  stationary  point  of  the  Lagrangian  function.    Figures  2-4  and  3-1 
summarize  the  algorithms  used  to  solve  for  the  maximum  likelihood  estimate  of  the 
acoustic  beacon's  position.    Both  algorithms  require  that  the  user  specify  the  maximum 
range  and  depth  of  the  search  area,  and  an  initial  guess  of  the  acoustic  beacon's 
location.    For  the  case  of  the  moving  beacon,  the  user  must  also  specify  the  maximum 
allowed  velocity  of  the  acoustic  beacon. 

Monte  Carlo  simulations  were  conducted  for  several  different  positions  and 
velocities  of  the  acoustic  beacon.    It  was  assumed  that  the  receiving  ship  followed  a 
hexagonal  search  path  with  legs  of  1000  meters.    In  practice,  the  actual  search  path  is 
not  critical  as  long  as  it  is  not  linear.    In  chapter  IV  results  from  six  scenarios  were 
presented.    Overall,  the  algorithms  developed  in  chapters  II  and  III  performed  well  for 
these  scenarios.   For  a  stationary  acoustic  beacon,  good  estimates  of  the  acoustic 
beacon's  location  were  obtain  using  GPS  errors  of  3  meters  and  25  meters  rms.    For 
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the  moving  acoustic  beacon,  a  good  estimate  of  the  acoustic  beacon's  location  was 
obtained  when  using  GPS  errors  of  3  meters  rms.    However,  the  accuracy  of  the 
algorithm  used  to  estimate  the  moving  acoustic  beacon's  location  degrades  for  GPS 
errors  of  25  meters  rms  unless  a  large  number  of  experiment  vectors  are  used,  or  a 
large  effective  sensor  spacing  is  used. 

From  the  results  of  the  Monte  Carlo  simulations,  it  was  shown  that,  in  general, 
as  the  number  of  experiment  vectors  (wM)  used  in  the  maximum  likelihood  estimation 
problem  increased,  or  the  effective  sensor  spacing  increased,  the  accuracy  of  the 
estimated  beacon  location  improved.    It  was  also  shown  that  the  accuracy  of  the 
estimated  beacon  location  improved  if  the  receiving  ship  passed  through  a  closest  point 
of  approach  to  the  acoustic  beacon.    In  all  cases,  the  accuracy  of  the  estimated  beacon 
position  was  significantly  better  when  using  3  meter  GPS  errors.    This  shows  that  to 
obtain  a  better  estimate  of  the  acoustic  beacon's  location,  the  position  of  the  receiving 
ship  must  be  measured  accurately. 

For  all  scenarios,  the  variance  of  the  estimated  beacon  position  and  velocity 
decreased  as  the  number  of  experiment  vectors  used  increased,  or  the  effective  sensor 
spacing  increased.    It  was  found  that  the  variance  of  the  moving  beacon's  estimated 
position  was  much  greater  then  the  variance  of  the  stationary  beacon's  estimated 
position.    This  is  due  the  manner  in  which  the  acoustic  beacon's  initial  position  and 
velocity  are  combined  in  the  modified  structural  model.   In  the  modified  structural 
model  given  by  equation    3-10,  the  individual  velocity  components  are  added  to  the 
initial  beacon  coordinates  x0,  y0,  and  z0  to  find  the  location  of  the  acoustic  beacon 
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when  it  transmits  a  signal.    As  a  result,  the  algorithm  estimates  the  value  of  the  sum  of 
the  initial  position  coordinates  and  the  velocities  better  then  the  individual  components. 
Consequently,  the  algorithm  can  not  discern  between  small  perturbations  in  the 
estimated  position  coordinates  and  the  estimated  velocities. 

From  these  results,  to  obtain  the  best  possible  estimate  of  the  acoustic  beacon's 
position  a  large  number  of  experiment  vectors  with  a  large  effective  sensor  spacing 
must  be  used.    However,  the  time  required  to  collect  the  measurement  vectors 
increases  with  both  the  number  of  experiment  vectors  and  the  effective  sensor  spacing. 
If  the  time  it  takes  to  obtain  an  estimate  of  the  acoustic  beacon's  position  is  an  issue, 
fewer  experiment  vectors  and  smaller  effective  sensor  spacings  can  be  used.    For  the 
hexagonal  search  path  shown  in  figure  4-1,  and  a  pulse  repetition  interval  of  2 
seconds,  a  minimum  of  20  experiment  vectors  with  an  effective  sensor  spacing  of  35 
pulse  repetition  intervals  are  required  to  obtain  a  decent  estimate  of  the  acoustic 
beacon's  position  for  a  stationary  beacon.    For  the  moving  beacon,  assuming  the  same 
search  path,  a  minimum  of  30  experiment  vectors  with  an  effective  sensor  spacing  of 
45  pulse  repetition  intervals  are  required. 

In  chapter  V  design  specifications  for  a  receiver  to  implement  the  algorithms 
given  in  chapters  II  and  III  were  developed.    The  synchronous  time  of  receipt  was 
measured  by  determining  the  time  of  arrival  of  the  acoustic  beacon's  envelope.    To 
determine  the  arrival  time  of  the  acoustic  beacon's  envelop,  the  beacon's  carrier 
frequency  was  first  removed  using  a  precision  rectifier  with  a  low  pass  filter  to  form 
an  envelope  detector.   The  output  of  the  envelope  detector  was  then  logarithmically 
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compressed  to  increase  the  dynamic  resolution  of  the  receiver.    Next,  the  output  of  the 
logarithmic  compressor  was  digitally  sampled  using  a  68HC11  microcontroller. 
Following  A/D  conversion,  the  sampled  envelope  was  passed  through  a  digital 
matched  filtered.    For  a  rectangular  windowing  function,  this  produces  a  unique 
maximum  output  which  was  used  to  determine  the  time  of  arrival.    Following  the 
design  specifications,  a  receiver  was  built  from  commonly  available  components. 
Experiments  conducted  on  receiver  showed  that  the  test  receiver  met  the  design 
specifications  of  section  5.2. 
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Appendix  1 

This  appendix  contains  the  schematic  diagrams  for  the  receiver  designed  in 
chapter  V. 
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Appendix  2 


This  appendix  contains  the  source  code  used  by  the  68HC1 1.    The  code  is 
based  on  a  full  function  SAIL  driver  written  by  Dr.  Albert  Bradley  and  operates  under 
serial  communication  interrupt  control.    The  sampling  rate  of  the  A/D  converter  is  set 
by  using  a  Timer  Output  Compare  function.    After  the  microcontroller  finishes  an 
initialization  period,  it  sits  in  a  wait  state  until  a  serial  communications  interrupt  or  a 
timer  output  compare  interrupt  occurs.    Once  the  interrupt  is  received,  the 
microcontroller  executes  the  requested  task,  and  then  returns  to  the  wait  state. 
#PTR  Driver 

THE  MINIMUM  POWER  DRAIN  IS- 

2.5  MA  IF  IN  WAIT  LOOP,  4.9152  MHZ 
6-7  MA  IF  WORKING,  NO  LOADS 

**************************************************************************** 

Mon,  Sep  17,  1990,  19:21  MINOR  CLEANUPS 
IT  CONTAINS- 

-?M  AND  !M  ARE  OPTIONAL  DEPENDING  ON  THE  'BIG'  FLAG 

-FULL  BAUD  SWITCH  CAPABILITY 

-FULL  USE  OF  EVEN  PARITY 

-FULL  TTY  HANDLES 
**************************************************************************** 

PROC     "68HC11" 
;  THIS  IS  THE  CONTROL  FOR  THE  CONDITIONAL  ASSEMBLY  OF  THE  !M  AND  ?M 
SECTIONS 
;  =1  WILL  INCLUDE  THEM 

=0  WILL  EXCLUDE  THEM  (SAVES  $118  BYTES  OF  CODE) 
LOAD:  EQU       1 

VIEW:  EQU       1 

**************************************************************************** 


DEFAULT  PARAMETERS 


DBAUD: 

EQU 

$30 

SAMPLE: 

EQU 

$07D1 

RADBUFF: 

EQU 

$3000 

ADBFULL: 

EQU 

S300B 

MAXBUF1: 

EQU 

$3100 

MAXBUF2: 

EQU 

$3200 

,START  UP  AT  9600  BAUD  WITH  8.0  MHZ  XTAL 
;1.0mSEC  SAMPLING  RATE  (ADJUSTED  FOR  ERRORS) 
;LOCATION  OF  RUNNING  A/D  BUFFER 
;A/D  BUFFER  FULL  AT  1 1  VALUES  (0-10) 
.LOCATION  OF  BUFFER  1 
;LOCATION  OF  BUFFER  2 
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ATTNINC: 
ATTNDEC: 
MAX1FL: 
MAX2FL: 


EQU  $E8 

EQU  $40 

EQU  $31  OF 

EQU  $320F 


;   ATTENUATOR  LEVELS 


DB00 
DB03 
DB09 
DB12 
DB18 
DB24 
DB30 


DMAXNUM: 

DPERIOD: 

DWIND: 


EQU  $01 

EQU  $09 

EQU  $11 

EQU  $19 

EQU  $21 

EQU  $81 

EQU  $B9 

EQU  $02 

EQU  $07D0 

EQU  $0014 


INCREASE  ATTN  AT  4.75  VOLTS 
INCREASE  THE  PREAMP  GAIN  AT  THIS  LEVEL 
CHECK  VALUE  TO  INITIALIZE  MAX  BUFFER 
CHECK  VALUE  TO  INITIALIZE  MAX  BUFFER 


0  DB  ATTEN 

3  DB  ATTEN 

9  DB  ATTEN 
12  DB  ATTEN 
18  DB  ATTEN 
24  DB  ATTEN 
30  DB  ATTEN 

DEFAULT  NUMBER  OF  MAX  POINTS  TAKEN 
DEFAULT  TO  2  SECOND  PERIOD 
DEFAULT  INDEX  WINDOW 


***************************************************************************** 


RP: 

PORTA 

PORTC 

PORTB 

DDRC: 

PORTD 

DDRD: 

PORTE: 

CFORC 
OC1M: 
OC1D: 

TCNT: 

DTIC1 

DTIC2 

DTIC3 

DTOC1 

DTOC2 

DTOC3 

DTOC4 

DTOC5 

TCTL1: 

TCTL2: 

TMSK1 

TFLG1: 

TMSK2 

TFLG2: 

PACTL: 

PACNT 

SPCR: 

SPSR: 


EQU 

$0000 

EQU 

RP+$00 

EQU 

RP+$03 

EQU 

RP+$04 

EQU 

RP+$07 

EQU 

RP+$08 

EQU 

RP+$09 

EQU 

RP+$0A 

EQU 

RP+$0B 

EQU 

RP+$0C 

EQU 

RP+$0D 

EQU 

RP+$0E 

EQU 

RP+$10 

EQU 

RP+S12 

EQU 

RP+$14 

EQU 

RP+$16 

EQU 

RP+$18 

EQU 

RP+$1A 

EQU 

RP+$1C 

EQU 

RP+$1E 

EQU 

RP+$20 

EQU 

RP+$21 

EQU 

RP+$22 

EQU 

RP+$23 

EQU 

RP+$24 

EQU 

RP+$25 

EQU 

RP+$26 

EQU 

RP+$27 

EQU 

RP+$28 

EQU 

RP+$29 

REGISTER  PAGE  ON  BASE  PAGE 
|OC  1  OC2.OC3.OC4IOC5.IC  1  .IC2.IC3| 


|X.X.SS.SCK!MOSI.MISO.TXD.RXD| 

|V7.V6.V5.V4!X.X.X.BRK| 
BAT.BAUD. 

TIMER  COMPARE  FORCE  REGISTER 
OUT  COMP  1  MASK  REG 
OUT  COMP  1  DATA  REG 
TIMER  REGISTER  (HIGH  BYTE) 
TIMER  INPUT  CAPTURE  1  (HI  BYTE) 
TIMER  INPUT  CAPTURE  2  (HI  BYTE) 
TIMER  INPUT  CAPTURE  3  (HI  BYTE) 
TIMER  OUTPUT  COMPARE  1  (HI  BYTE) 
TIMER  OUTPUT  COMPARE  2  (HI  BYTE) 
TIMER  OUTPUT  COMPARE  3  (HI  BYTE) 
TIMER  OUTPUT  COMPARE  4  (HI  BYTE) 
TIMER  OUTPUT  COMPARE  5  (HI  BYTE) 
TIMER  CONTROL  REG  1 
TIMER  CONTROL  REG  2 
TIMER  INTERRUPT  MASK  REG  1 
TIMER  INTERRUPT  FLAG  REG  1 
TIMER  INTERRUPT  MASK  REG  2 
TIMER  INTERRUPT  FLAG  REG  2 
PULSE  ACCUMULATOR  CONTROL  REG 
PULSE  ACCUMULATOR  COUNT  REG 
SPI  CONTROL  REGISTER 
SPI  STATUS  REGISTER 
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SPDR: 

EQU 

RP+S2A 

BAUD: 

EQU 

RP+S2B 

SCCR1: 

EQU 

RP+S2C 

SCCR2: 

EQU 

RP+$2D 

SCSR: 

EQU 

RP+$2E 

SCDR: 

EQU 

RP+S2F 

ADCTL: 

EQU 

RP+S30 

ADR1 

EQU 

RP+$3 1 

ADR2 

EQU 

RP+$32 

ADR3 

EQU 

RP+S33 

ADR4 

EQU 

RP+$34 

OPTION: 

EQU 

RP+$39 

HPRIO: 

EQU 

RP+$3C 

INIT: 

EQU 

RP+$3D 

.**************************** 

;  SAIL  inteface  RAM  workspace 

R.TUMP: 

EQU 

$40 

RVECT: 

EQU 

$41 

$42 

XJUMP: 

EQU 

$43 

XVECT: 

EQU 

$44 
$45 

JUMP2: 

EQU 

$46 

VECT2: 

EQU 

$47 
$48 

SCRTCH1 

EQU 

$49 

SCRTCH2 

EQU 

$4A 

SCRTCH3 

EQU 

$4B 

SCRTCH4 

EQU 

$4C 

SCRTCH5 

EQU 

$4D 

XTTY: 

EQU 

$4E 
$4F 

.********. 

******************** 

;  PTR  DaU 

inteface  RAM  workspe 

PERINDX 

9 

EQU 

$50 
$51 

PERIOD: 

EQU 

$52 
$53 

MAXBUFI 

7:         EQU 

$54 
$55 

MAXFULI 

> 

/         EQU 

$56 
$57 

ADBFPTR 

EQU 

$58 

> 

$59 

TXBUFF: 

EQU 

$5A 
$5B 

TXBFI 

JLL 

:          EQU 

$5C 

;SPI  DATA  REGISTER 


;[RAM3.2.1.0!REG3.2.1.0] 


JUMP  INST  GOES  HERE. 

HI 

LO 
XMIT  JUMP  INST 

HI 

LO 
2ND   JUMP  INST 

HI 

LO 
SCRATCH  LOC  1 
SCRATCH  LOC  2 
SCRATCH  LOC  3 
SCRATCH  LOC  4 
SCRATCH  LOC  5 

;TTY  POINTER  HI 
LOW 


;PERIOD  TIMER  INDEX  HI 

LOW 
;LENGTH  OF  PERIOD  HI 

LOW 
;MAXIMUMS  BUFFER  LOCATION  HI 

LOW 
;MAX  BUFFER  FULL  LOCATION  HI 

LOW 
;RUNNING  A/D  BUFFER  LOCATION  HI 

LOW 
;MAXIMUMS  BUFFER  TO  TX  HI 

LOW 
;TX  BUFFER  FULL  LOCATION  HI 


161 


° 

$5D 

TX1FLG: 

EQU 

$5E 

TX2FLG: 

EQU 

$5F 

MAXFLG: 

EQU 

$60 

AGCFLG: 

EQU 

$61 

BIG: 

EQU 

$62 

MAXNUM: 

EQU 

$63 

TXMHI: 

EQU 

$64 

TXMLO: 

EQU 

$65 

TXIHI: 

EQU 

$66 

TXILO: 

EQU 

$67 

TXINT: 

EQU 

$68 

TEMPIND: 

EQU 

$70 

TEMPMAX: 

EQU 

$72 

WINDOW: 

EQU 

$74 

WINCHK: 

EQU 

$76 

INDXCHK: 

EQU 

$78 

LOW 
;FIRST  MAXIMUMS  SENT  FLAG 
;SECOND  MAXIMUMS  SENT  FLAG 

WHICH  MAXIMUM  BUFFER  TO  SAVE  FLAG 
MANUAL  GAIN  CONTROL  FLAG 
LARGEST  A/D  VALUE  PER  PERIOD  LOCATION 
NUMBER  OF  MAXIMUMS  LOCATION 
TRANSMIT  OUT  BUFFERS 


INTERM  STORAGE  FOR   TX  POINTER 
INTERM  STORAGE  FOR  MAXIMUM  INDEX 
INTERM  STORAGE  FOR  MAXIMUM 
MAXIMUM  CHECK  WINDOW  SIZE 
USED  FOR  TESTING  IF  WITHIN  WINDOW 


.************ ********************************************************** 

ORG       $E800     ;ASSUME  27C64  EPROM 
;    SAIL  Address  stored  here.. 

ADDR:  FCB        "#PTR"  ;SAIL  ADDRESS 

FCB        $00  JERMINATOR 


.************************«********************************************* 


START: 


MOVE  REGISTERS  TO  BASE  PAGE  (00->  INIT) 
SET  STACK  POINTER 
SET  DEFAULT  BAUD 

;8  DATA  BITS,  WAKE  ON  IDLE? 
;ONLY  REC  INTERRUPTS  YET 


********************************************************************** 


SEI 

CLR 

$103D 

LDS 

#$00FF 

LDAA 

#DBAUD 

STAA 

BAUD 

CLR 

SCCR1 

LDAA 

#$2C 

STAA 

SCCR2 

***************** 

r*T*T*T"l  T  TT^T"     ▼■»■  tt-tt   a   t    t 

ITERUP 
LDAA 

1    11N111AL1 
#$40 

STAA 

TCTL1 

CLR 

TMSK2 

LDAA 

#$90 

STAA 

OPTION 

LDAA 

#$20 

STAA 

ADCTL 

LDAA 

#$88 

STAA 

PACTL 

CLR 

MAXFLG 

CLR 

TX1FLG 

CLR 

TX2FLG 

CLR 

AGCFLG 

CLR 

BIG 

CLR 

TXMHI 

JOGGLE  OC2  ON  EACH  COMPARE 

;SET  PRESCALE  TO  /l 

;TURN  ON  THE  A/D  CONVERTER 

USE  PEO  FOR  A/D  INPUT,  SINGLE  CHANNEL, 

CONTINUOUS  SAMPLING 

SET  PORT  A  PINS  7  AS  OUTPUT 

INITIALIZE  TO  FIRST  MAXIMUMS  BUFFER 

INITIALIZE  TO  NOT  TXD 

INITIALIZE  TO  NOT  TXD 

INITIALIZE  TO  AGC  ON 

INITIALIZE  THE  LARGEST  VALUE  TO  ZERO. 

CLEAR  THE  OUTGOING  BUFFERS 
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CLR 

TXMLO 

CLR 

TXIHI 

CLR 

TXILO 

LDAA 

#DB00 

STAA 

PORTA 

LDD 

tfRADBUFF 

STD 

ADBFPTR 

LDX 

#MAXBUF1 

STX 

MAXBUFF 

STX 

TXBUFF 

LDAB 

#DMAXNUM 

ADDB 

#DMAXNUM 

STAB 

MAXNUM 

ABX 

STX 

MAXFULL 

STX 

TXBFULL 

LDD 

#DPERIOD 

STD 

PERIOD 

LDX 

#$0000 

STX 

PERINDX 

LDAA 

#$00 

LDX 

ADBFPTR 

CLRAD: 

STAA 
INX 

$oo,x 

CPX 

#ADBFULL 

BLO 

CLRAD 

LDX 

#MAXBUF1 

CLMX1: 

STAA 
INX 

$00,X 

CPX 

#MAX1FL 

BLS 

CLMX1 

LDX 

#MAXBUF2 

CLMX2: 

STAA 
INX 

$00,X 

CPX 

#MAX2FL 

BLS 

CLMX2 

LDD 

#DWIND 

STD 

WINDOW 

9 
» 

CLR 

SCRTCH1 

LDAA 

#$7E 

STAA 

RJUMP 

STAA 

XJUMP 

STAA 

JUMP2 

LDD 

flSETUNAD 

STD 

RVECT 

STD 

XVECT 

CLI 

;SET  0  DB  OF  ATTENUATION 

;SET  A/D  DATA  BUFFER  LOCATION  IN  BASE  PAGE 

;SET  FIRST  MAX  BUFFER  LOCATION  IN  BASE  PAGE 


;SET  THE  NUM  MAX  CHECK  VALUE 
;SET  BUFFER  FULL  TO  2xDMAXNUM 
;SET  THE  PERIOD  SIZE 

-.INITIALIZE  PERIOD  TIMER  TO  ZERO 

;CLEAR  THE  RUNNING  A/D  BUFFER 

;CLEAR  THE  FIRST  MAXIMUM  BUFFER 


iCLEAR  THE  SECOND  MAXIMUM  BUFFER 


;SET  DEFAULT  INDEX  WINDOW 


USE  AS  SAIL  MODE  FLAG  &  ADDR  POINTER 
MUST  WRITE  JMP  INSTS. 
INTO  SAIL  WORK  AREA 


;SET  VECTORS  TO  INITIAL  VALUES 


;AND  FINALLY  ALLOW  INTERRUPTS 


tHttt»ltt**ttti»*tH*ttHttttt»ttttt'M»ttt*M»M*IM»MMtmit*MM 
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********************************************************************** 

;    MAIN  PROGRAM  BODY 

LOOP:  WAI  ;WAIT  TILL  INTERRUPTED.. 

BRA       LOOP 

********************************************************************** 

********************************************************************** 

TIMER  INTERUPT  HANDLER 
Fri,  Jul  10,  1992,  13:02 
Wed,  Jul  22,  1992,8:35 
Fri,  Apr  23,  1993,  9:12 
Thu,  May  20,  1993,  1:52  PM 


OC2: 

LDD 

DTOC2 

ADDD 

#SAMPLE 

STD 

DTOC2 

> 

LDAA 

#$FF 

SUBA 

ADR1 

CMPA 

BIG 

BLO 

Til 

STAA 

BIG 

Til: 

LDX 

ADBFPTR 

STAA 

$00,X 

INX 

CPX 

#ADBFULL 

BLO 

TI2 

LDX 

flRADBUFF 

TI2: 

STX 

ADBFPTR 

5 

LDX 

#RADBUFF 

LDY 

#$0000 

SUMMING: 

LDAB 

ABY 

INX 

$00,X 

CPX 

#ADBFULL 

BLO 

SUMMING 

? 

LDX 

MAXBUFF 

LDD 

PERINDX 

STD 

TEMPIND 

CPD 

WINDOW 

» 

BHI 

TI1_1_1 

CPY 

S00.X 

BLO 

TI1_2 

STY 

$oo,x 

LDD 

TEMPIND 

STD 

$10,X 

BRA 

TIENDJ 

;GET  LAST  VALUE  IN  TOC2 
;AND  ADD  ONE  PERIOD  TO  IT 
;STORE  BACK  IN  TOC2 

;NORMALIZE  THE  A/D  VALUE 

;IS  A/D  VALUE  GREATER  THEN  BIG? 
;IF  IT  IS  STORE  IN  BIG  ELSE  MOVE  ON 


;GET  THE  CURRENT  A/D  POSITION 

;STORE  THE  VALUE 

;UPDATE  THE  POINTER 

;CHECK  IF  AT  LAST  A/D  STORAGE  LOCATION 

;IF  NOT  INC  ADBPTR  AND  MOVE  ON 

;IF  YES  REINITIALIZE  ADBPTR  AND  MOVE  ON 

;SAVE  THE  A/D  STORAGE  POINTER 

;GET  THE  A/D  BUFFER  LOCATION 

;INITIALIZE  THE  SUMATION  VALUE 

;GET  THE  A/D  VALUE  TO  ADD 

;SUM=SUM+A/D 

;CONTINUE  UNTIL  ALL  VALUES  IN  THE  A/D 

;BUFFER  ARE  SUMMED 


;GET  THE  BUFFER  TO  WRITE  TO 
;SETUP  FOR  TESTING  MAX  VALUES 

;SEE  IF  THE  MAX  IS  CLOSE  TO  THE  START  OF 

THE  PERIOD 
;IF  NOT  MOVE  ON,  OTHERWISE 
;CHECK  FOR  A  NEW  MAXIMUM 
;IF  NOT  GOTO  CHECK  FOR  SECONDARY  MAX'S 
;IF  YES  JUST  REPLACE  CURRENT  MAX 
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TI1_1_1: 

ADDD 

WINDOW 

CPD 

PERIOD 

BLO 

TI1_1_2 

CPY 

$00,X 

BLO 

TI1_2 

STY 

$00,X 

LDD 

TEMPIND 

STD 

$10,X 

BRA 

TIENDJ 

TI1_1_2: 

LDD 

PERINDX 

SUBD 

WINDOW 

STD 

WINCHK 

CPY 

$00  ,x 

BLO 

TI1_2 

CPD 

$10,X 

BHI 

TI1_1 

STY 

$00,X 

LDD 

TEMPIND 

STD 

$10,X 

TIENDJ: 

BRA 

TIEND 

TI1_1: 

LDD 

$00,X 

STY 

$00,X 

STD 

TEMPMAX 

LDY 

$10,X 

LDD 

TEMPIND 

STD 

$10,X 

STY 

TEMPIND 

LDY 

TEMPMAX 

INX 

INX 

CPX 

MAXFULL 

BLO 

TI1_1 

BRA 

TIEND 

9 

TI1_2: 

LDD 

$10,X 

ADDD 

WINDOW 

STD 

INDXCHK 

INX 

INX 

CPX 

MAXFULL 

BHS 

TIEND 

CPY 

$00  ,X 

BLO 

TI1_2 

LDD 

TEMPIND 

CPD 

INDXCHK 

BLO 

TIEND 

LDD 

PERIOD 

SUBD 

PERINDX 

;SEE  IF  THE  MAX  IS  CLOSE  TO  THE  END  OF  PERIOD 

IF  NOT  MOVE  ON,  OTHERWISE 
CHECK  FOR  A  NEW  MAXIMUM 
IF  NOT  GOTO  CHECK  FOR  SECONDARY  MAX'S 
;IF  YES  JUST  REPLACE  CURRENT  MAX 


;CHECK  FOR  A  NEW  MAXIMUM 

;IF  NOT  CHECK  FOR  SECONDARY  MAX'S 

;CHECK  IF  WITHIN  WINDOW 

;IF  NO  REPLACE  ALL  MAX'S 

;IF  YES  JUST  REPLACE  CURRENT  MAX 


;SHIFT  ALL  OLD  MAX'S  ONE  LOCATION  AND 
;SAVE  THE  NEW  MAX  VALUE 

;SHIFT  THE  INDICIES 


INCREMENT  TO  THE  NEXT  MAX 
;SEE  IF  DONE 

;CHECK  FOR  SECONDARY  MAX'S 
;SET  UP  INDEX  WINDOW 

;MOVE  TO  THE  NEXT  MAX 

;SEE  IF  DONE 

;LOOK  FOR  NEW  SECONDARY 


;IF  WITHIN  THE  WINDOW  OF  THE  LARGER  MAX 
JGNORE  THE  VALUE 
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Til    3: 


TIEND: 


CPD 

WINDOW 

BLO 

TIEND 

LDD 

PERINDX 

SUBD 

WINDOW 

CPD 

$10,X 

BHI 

TI1_3 

STY 

$00  ,X 

LDD 

PERINDX 

STD 

$10,X 

BRA 

TIEND 

LDD 

$00,X 

STY 

$00,X 

STD 

TEMPMAX 

LDY 

$10,X 

LDD 

TEMPIND 

STD 

$10,X 

STY 

TEMPIND 

LDY 

TEMPMAX 

INX 

INX 

CPX 

MAXFULL 

BLO 

TI1_3 

LDX 

PERINDX 

INX 

CPX 

PERIOD 

BLO 

Till 

;IF  ON  THE  SCREEN  WRAP  IN  WINDOW  IGNORE 

;IF  WITHIN  THE  WINDOW  OF  THE  SECONDARY 
;JUST  REPLACE  THE  ONE  VALUE 


;ELSE  REPLACE  AND  SHIFT  OLD  VALUES  DOWN 


;GET  THE  PERIOD  COUNTER  AND  INCREMENT 
;IS  THE  PERIOD  COMPLETED? 


INC        MAXFLG 
BRCLR  MAXFLG,$01,TI7 


;ARE  WE  IN  MAXIMUMS  BUFFER  1  OR  2? 


TI7: 
TI8: 


CLR 

LDY 

BRA 

CLR 

LDY 

STY 

LDAB 

ABY 

STY 


TX1FLG 

#MAXBUF2 

TI8 

TX2FLG 

#MAXBUF1 

MAXBUFF 

MAXNUM 

MAXFULL 


TI9: 


BRSET  AGCFLG,$01JI 

LDAA  BIG 

CMPA  #ATTNINC 

BLO  TI9 

JSR  ATTN 

BRA  TI10 

CMPA  #ATTNDEC 

BHI  TI10 

JSR  INC 


;CLEAR  BUFFER  1  TX'D  FLAG 


:CLEAR  BUFFER  2  TX'D  FLAG 


iUPDATE  THE  BUFFER  TO  USE 


;UPDATE  THE  FULL  BUFFER  VALUE 

10  ;IF  MANUAL  GAIN  SET  DON'T  CHECK  AGC 

JEST  IF  GAIN  NEEDS  TO  BE  DECREASED 
;IF  NOT  MOVE  ON 

;GO  TO  ATTN  FOR  MORE  ATTENUATION 

JEST  IF  GAIN  NEEDS  TO  BE  INCREASED 

;IF  NOT  MOVE  ON 

;GO  TO  INC  FOR  LESS  ATTENUATION 
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TI10:  CLR  BIG 

LDX  #$0000 

Till:  STX  PERINDX 

LDAA  #$40 

STAA  TFLG1 
RTI 


;RESET  BIG  FOR  NEXT  PERIOD 
;CLEAR  THE  PERIOD  COUNTER 
;RESET  TIMER  FLAGS 


************************************************************ 

SCI  INTERRUPT  HANDLER  (SAIL  DRIVER) 

Sat,  May  12,  1990,  20:34  COMPACT  BY  20  BYTES  BY  USING  RSET: 

Sun,  May  13,  1990,  12:36  COMPACT  BY  USING  CONDITIONAL  ASSEMBLY 

Sun,  May  13,  1990,  12:37   AND  BY  USING  TTY  FOR  PROMPT 

Mon,  Sep  17,  1990,  19:20  ADD  IN4  TO  TTY 

BRCLR  SCSR,$0E,CKCHAR         ;TEST  FOR  VALID  CHAR 


SCI: 
& 


ECHO: 
SCIXIT: 


LDAA 

ANDA 

BEQ 

LDAA 

NOP 

RTI 


SCSR 
#$0E 

CKCHAR 
SCDR 


JEST  OR.NF.FE 

IF  GOOD,  GO  ON.. 
READ  BAD  CHAR  TO  CLEAR? 
RECEIVE  AN  ECHO  CHARACTER  (&  IGNORE!) 
&  EXIT 


CKCHAR: 


BRSET  SCSR,$20,READD 


READD: 


LDAA  SCSR 

ANDA  #$20 

BNE  READD 

JMP  CHECKX 


LDAA 

TAB 

LDX 

ABX 

LDAB 

BNE 

ANDA 

TAB 

CMPA 

BEQ 

JMP 


SCDR 

#PARITY 

0,X 
SCIXIT 

#$7F 

#•#' 

GOTNUM 

RJUMP 


;TEST  DA 


;IF  NOT,  XMIT 

READ  DATA  TO  A.. 

AND  COPY  TO  B 

POINT  PARITY  TABLE 

POINT  INTO  PARITY  TABLE 

GET  PARITY  WORD 

REJECT  IF  NOT  EVEN  PARITY 

ELSE  REMOVE  PARITY  FOR  SUBSEQUENT  TESTS 

(ALSO  COPY  TO  B) 

IS  IT  '#•? 

;ELSE  GO  THRU  VECTOR 


ATXIT: 


JMP        SCIXIT 


;NO  FURTHER  USE  FOR  THIS  CHAR,  EXIT 


SAIL  ADDRESS  RECOGNIZE  SECTION 


GOTNUM: 

LDAB 

#01 

STAB 

SCRTCH1 

BCLR 

SCCR2,$D2 

;& 

LDAA 

SCCR2 

ANDA 

#$2C 

STAA 

SCCR2 

LDD 

#READAD 

GOT  #  CODE 
SET  SAIL  FLAG  TO  01 
TURN  OFF  XMIT  INTERRUPTS 

;TURN  OFF  XMIT  INTERRUPTS 

;POINT  READ  ADDRESS 
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RSET: 

STD 

RVECT 

JMP 

SCIXIT 

READAD: 

LDAB 

SCRTCH1 

CMPB 

#$01 

BNE 

TRYADD 

CMPA 

#'0' 

BEQ 

TSTBAUD 

TRYADD: 

LDX 
ABX 

#ADDR 

CMPA 

0,X 

BEQ 

NEXTAD 

> 

SETUNAD: 

LDD 

#UNADDR 

STD 

RVECT 

9 

UNADDR: 

CLR 

SCRTCH1 

BCLR 

SCCR2,$D2 

;& 

LDAA 

SCCR2 

ANDA 

#$2C 

STAA 

SCCR2 

LDD 

#XPASS 

XSET: 

STD 

XVECT 

JMP 

SCIXIT 

NEXT  AD: 

INX 

INC 

SCRTCH1 

TST 

0,X 

BEQ 

GOTADDR 

JMP 

SCIXIT 

* 

GOTADDR: 

LDD 

#CONCHAR 

JMP 

RSET 

..MAY  ENTER  HERE  FROM  MANY  OTHER  PLACES 
AND  EXIT 

GET  SMODE  COUNT 

IS  THIS  THE  FIRST  CHAR? 

IF  FIRST,  IS  IT  '0'? 

IF  SO,  MAY  BE  BAUD  SWITCH 

CONTINUE  ON  BELOW... 

;ELSE  POINT  X  TO  ADDR 
ADD  TO  X 

COMPARE  NEW  CHAR  TO  A 
IF  MATCH,  LOOK  FOR  NEXT  IN  LIST 

ELSE  SET  UNADDRESS  STATE 


-.CLEAR  SAIL  MODE  TO  00 
;TURN  OFF  XMIT  INTERRUPTS 

;TURN  OFF  XMIT  INTERRUPTS 

;SET  XMIT  VECTOR  TO  PASS 


;POINT  NEXT  ADD  CHAR 
;(&  INC  COUNTER) 
JEST  IT, 
;  TERMINATOR? 
;ELSE  SAME  VECTOR 


;REC  CONTROL  CHAR  NEXT. 


;   TEST  FOR  BAUD  CHANGE  COMMAND 
TSTBAUD:  LDD       #BAUD2 

.IMP        RSET 


BAUD2:  CMPA    #'0' 

BEQ       BAUD3 
JMP        SETUNAD 


;GOT  SECOND  0? 


;   COME  HERE  IF  GOT  #00  (BAUD  CHANGE) 

BAUD3:  LDX       #SCRTCH1  ;POINT  TO  5  CHAR  BUFFER 

STX        VECT2  ;SAVE  AT  VECT2 

LDD       #BAUD4 

JMP        RSET 


BAUD4: 


LDX       VECT2 
CMPA    #' ' 


;GET  POINTER 
;IS  IT  SPACE? 
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BNE 

BAUD5 

LDAA 

#'0' 

BAUD5: 

STAA 
INX 

0,X 

CPX 

#SCRTCHl+5 

BEQ 

BAUD6 

STX 

VECT2 

JMP 

SCIXIT 

BAUD6: 

LDX 

SCRTCH1+3 

CPX 

#$3030 

BNE 

WAITBRK 

..CHANGE  SPACES  TO  O'S 

STORE  CHAR 

ADVANCE  POINTER 

PAST  END  OF  5  CHAR  BUFFER? 

;IF  NOT  DONE,  SAVE  POINTER 
;AND  GET  MORE 

GET  LAST  TWO  CHARS 

ARE  LAST  TWO  CHARS  BOTH  0? 

IF  NOT  VALID,  SET  UP  TO  WAIT  FOR  BREAK 


;  IF  LAST  TWO  CHARS  ARE  00,  CHECK  BUFFER  AGAINST  DATA  TABLES  FOR  A  MATCH 
LDD       #BAUDTBL         ;SET  UP  TABLE  POINTER 
STD        VECT2  ;AND  STORE  IN  JUMP2  VECTOR 


TRY  EACH  TABLE  SEPARATELY,  00  AS  1ST  CHAR  SIGNALS  END  OF  TABLE 

GET  TABLE  POINTER 
AND  TABLE  ELEMENT 
IF=00,  WAS  NO  MATCH,  WAIT  FOR  BREAK 


;INIT  BUFFER  POINTER  TO  TOP 
&  SAVE  IN  XMIT  JUMP  VECTOR 

GET  BUFFER  POINTER 
TO  GET  BUFFER  CHAR  TO  A 
INX  BUF  POINT  WHILE  WE'RE  HERE 
&  SAVE- 
NOW  GET  TABLE  POINTER 
&  USE  TO  COMPARE  CHARS 

IF  MATCH,  MOVE  AHEAD  TABLE  POINTER 
LOOK  AT  NEXT  TABLE  ELEMENT 

IF  IT'S  00,  FULL  MATCH! 

ELSE  SAVE  TABLE  POINTER 

AND  TRY  NEXT  CHAR 

INC  TABLE  POINTER 
AND  LOOK  FOR  00 
LOOP  TILL  IT'S  FOUND 
INC  OVER  NULL 
&  BAUD  SET  BYTE 

AND  REPLACE  TO  HOLDING  LOCATION 
GO  BACK  TO  CHECK  NEXT  TABLE 

TURN  OFF  SCI  INTERRUPTS 
(REQUIRES  TOF  INTERRUPT  TO  RESTART) 
AND  SET  VECTORS  FOR  NEW  ADDRESS.. 


BTRY: 

LDX 

VECT2 

LDAA 

o,x 

BEQ 

WAITBRK 

;   COMPARE  BUFFER  WITH  ONE  TABL1 

LDX 

#SCRTCH1 

STX 

XVECT                ; 

;   COMPARE  EACH  CHARACTER 

COMPARE: 

LDX 

XVECT                ; 

LDAA 

o,x 

INX 

STX 

XVECT                ; 

LDX 

VECT2 

CMPA 

o,x 

BNE 

NOMATCH 

CMATCH: 

INX 

LDAA 

0,X 

BEQ 

MATCH 

STX 

VECT2 

BRA 

COMPARE 

NOMATCH: 

INX 

LDAA 

0,X 

BNE 

NOMATCH 

INX 

INX 

STX 

VECT2 

BRA 

BTRY 

WAITBRK: 

LDAA 

#$oc 

STAA 

SCCR2                 ; 

JMP 

SETUNAD 
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;*BAUD*    ALL  LINES  WITH  THIS  ITEM  ARE  MODIFIED  FOR  EACH  BAUD  GROUP 
;    MATCH  TABLE  FOR  BAUD  RATE  SWITCH 


BAUDTBL: 


FCB 
FCB 
FCB 
FCB 
FCB 
FCB 
FCB 


•096\$00,$30 
•048',$00,$31 
'024',$00,$32 
'012',$00,$33 
"006',$00,$34 
•003',$00,$35 
$00 


MATCH: 


INX 

LDAA  0,X 

STAA  BAUD 

JMP  SETUNAD 


9600 

4800  BAUD 

2400 

1200 

600 

300 
DONE 


♦BAUD* 
♦BAUD* 
♦BAUD* 
♦BAUD* 
♦BAUD^ 
♦BAUD^ 


PASS  00  TERMINATOR 

GET  BAUD  BYTE 

AND  RE-WRITE 

AND  PREPARE  FOR  NEW  ADDRESSING. 


?M  COMMAND  -  DATA  INPUT  SECTION 
if  VIEW 


QUERYM: 


SAVEADD: 


STARTL: 


STARTL2: 


& 


LDD  #SAVEADD 

JMP  IN4 

LDD  SCRTCH1 

STD  SCRTCH3 

LDD  #STARTL 

JMP  IN4 

LDD  SCRTCH1 

BNE  STARTL2 

JMP  PROMPT 

LDD  #ECHO 

STD  RVECT 

BSET  SCCR2,$E0 

LDAA  SCCR2 

ORAA  #$E0 

STAA  SCCR2 

JMP  OUTLINE 


;NOW  INPUT  ADDRESS 

GET  ADDRESS, 

&  SAVE  IN  ADDRESS  POINTER 

THEN  GET  LENGTH 

IF  LENGTH  NE  0000 
CARRY  ON.. 
ELSE  QUIT 

PREPARE  TO  IGNORE  ECHO  CHARS 

START  XMIT  INTERRUPTS 

START  XMIT  INTERRUPTS 

&  SEND  A  LINE.. 


;  ..THE  ?M  DUMP  IS  STORED  IN  THE  XMIT  SERVICE  SECTION  BELOW 
else 
endif 


!M  SECTION 


IF 


LOAD 


BANGM: 


KEEPADD: 


LDD       #KEEPADD 
JMP        IN4 

LDD       #HIHEX 


•.CONDITIONAL  ASSEMBLY  OF  LOAD  M  SECTION 
;INPUT  STARTING  ADDRESS 

;WAIT  FOR  HIGH  HEX  CHAR 
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JMP 

RSET 

> 

HIHEX: 

JSR 

ASCHEX 

ATTEMPT  CONVERT  TO  HEX 

BCS 

TERMIN 

CHECK  TERMINATOR  IF  NOT.. 

ASLA 

ASLA 

MOVE  OVER  NIBBLE 

ASLA 

ASLA 

STAA 

SCRTCH5 

LDD 

flLOWHEX 

JMP 

RSET 

LOWHEX: 

JSR 

ASCHEX 

CONVERT  LOW 

BCC 

STASH 

JMP 

PROMPT 

PROMPT  IF  BAD  SECOND  CHAR 

STASH: 

LDX 

SCRTCH1 

GET  POINTER 

ORAA 

SCRTCH5 

COMBINE  NIBBLES 

STAA 

0,X 

STORE  IT.. 

INX 

INC  & 

STX 

SCRTCH1 

RESTORE  POINTER 

LDD 

#HIHEX 

JMP 

RSET 

TERMIN: 

ANDA 

#$7F 

MASK  OFF  FLAG  BIT 

CMPA 

#$0D 

IS  IT  CR? 

BNE 

TERMIN2 

JMP 

PROMPT 

TERMIN2: 

CMPA 

#•  ' 

IS  IT  SPACE? 

BNE 

TERMIN3 

LDD 

#HIHEX 

JMP 

RSET 

TERMIN3: 

CMPA 

#'■; 

OR  ';'  ? 

BNE 

TERMIN4 

LDD 

#BANGM 

BRA 

PASSLF 

TERMIN4: 

CMPA 

#7 

,OR  V  ? 

BNE 

TERMIN5 

LDD 

#SETHIHX 

PASSLF: 

STD 

VECT2 

LDD 

#PASSLF2 

JMP 

RSET 

PASSLF2:CMPA 

#$0A 

,GOT  LF  YET? 

BNE 

PXIT 

JMP 

JUMP2 

,IF  YES,  EXIT  THRU  JMP2 

PXIT: 

JMP 

SCIXIT 

.ELSE  WAIT  FOR  MORE  CHARS.. 

SETHIHX: 

LDD 

#HIHEX 

,IF  V  THEN  PREP  FOR  MORE  HEX 
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JMP        RSET 


TERMIN5: 


JMP        PROMPT 
endif 


;TO  PROMPT  IF  NOT  VALID  CHAR 


IN4  HEX  DIGITS 

INPUTS  HEX  DIGITS  TILL  TERMINATED  BY  A  SPACE  OR 
BY  A  CR.  (OR  BY  UNADDRESS).  RESULT  LEFT  AT  SCRTCHI, 2 
EXITS  THRU  JUMP2  WHEN  DONE  (TARGET  IN  D  ON  ENTRY) 


IN4: 


IN4HEX: 


CKEND: 


INEXIT: 


JMP        SCIXIT 


JMP        JUMP2 


STD 

VECT2 

STORE  EXIT  VECTOR 

CLR 

SCRTCH1 

CLEAR  INPUT  BUFFER 

CLR 

SCRTCH2 

LDD 

#IN4HEX 

POINT  CHAR  RECEIVER 

JMP 

RSET 

JSR 

ASCHEX 

CONVERT  TO  HEX 

BCS 

CKEND 

IF  NOT  HEX,  CHECK  FOR  END 

PSHA 

SAVE.. 

LDAA 

SCRTCHI 

HI  TO  A 

LDAB 

SCRTCH2 

ASLD 

SHIFT  OVER  FOUR 

ASLD 

ASLD 

ASLD 

STAA 

SCRTCHI 

RETURN  HIGH 

STAB 

SCRTCH2 

ANDB 

PULA 

RETRIEVE  NEW  NIBBLE 

ORAA 

SCRTCH2 

ADD  NEW  NIBBLE 

STAA 

SCRTCH2 

&  UPDATE 

JMP 

SCIXIT 

ANDA 

#$7F 

CLEAN  OFF  MS  FLAG  BIT 

CMPA 

tt" 

IS  IT  SPACE? 

BEQ 

INEXIT 

CMPA 

#$0D 

IS  IT  CR? 

BEQ 

INEXIT 

;ELSE,  GET  ANOTHER  CHAR 

;IF  DONE,  CARRY  ON  THRU  VECTOR. 


INPUT  ONE  HEX  BYTE  AND  CONTINUE  THRU  JUMP2 


INBYTE: 


ASLA 

ASLA 

ASLA 

ASLA 

STAA     SCRTCH5 

LDD       #INBYTE2 

JMP        RSET 


;MOVE  OVER 


;SAVE 

;POINT  TO  NEXT  SEGMENT 
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INBYTE2: 


SAVEDAT 


JSR         ASCHEX 
BCC       SAVEDAT 
JMP        SETUNAD 

:ORAA  SCRTCH5 
JMP        JUMP2 


;CONVERT  LOW  NIBBLE 

;UNADDRESS  IF  ERROR 

;COMBINE 

;AND  CARRY  ON  THRU  VECTOR2 


NOW  CHECK  THE  TRANSMIT  SITUATION 
CHECKX:  BRCLR  SCSR,$80,XERROR 

&  LDAA    SCSR  ;MAKE  SURE  XMIT  BIT  WAS  SET 

ANDA    #$80 

BEQ       XERROR 

JMP        XJUMP  ;GO  THRU  XMIT  VECTOR 

;  THESE  SEGMENTS  ARE  ENTERED  THRU  XJUMP  AND  XVECTOR.. 
XERROR:  NOP  ;TRIG  LOC  FOR  DIAGNOSTICS 

;   XJUMP  TARGETS.. 
XPASS:  BCLR     SCCR2,$D0 

&  LDAA  SCCR2 

ANDA  #$2F 
STAA  SCCR2 

JMP        SCIXIT 


if  VIEW  ;a  conditional  segment 

;  OUTPUT  A  LINE  OF  DATA  (FROM  ?M  DUMP) 
OUTLINE:  LDD       #OUTLF  ;&  SET  UP  TO  XMIT 

STD       XVECT 

LDAA    #$0D  ;SENDCR 

.IMP        SETOUT 


OUTLF:  LDD  #OUTADDR 

STD  XVECT 

LDAA  #$0A 

JMP  SETOUT 


;SEND  LF 


OUTADDR: 


LDD       #LOWADDR 
STD       VECT2 
LDAA    SCRTCH3 
JMP        OUTBYTE 


;PREP  OUTBYTE  XIT 
;GET  HIGH  ADDRESS 


LOWADDR: 

LDD 

#LOWADD2 

.IMP 

XSET 

> 

LOWADD2: 

LDD 

#ADDRSP 

STD 

VECT2 

LDAA 

SCRTCH4 

.IMP 

OUTBYTE 

;EXIT  FROM  2ND  OUTBYTE. 


;NOW  LOW  ADDRESS 
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ADDRSP: 

LDD 

#SENDSP 

JMP 

XSET 

SENDSP: 

LDD 

#OUTDAl 

;EXIT  FROM  2ND  OUTBYTE... 


LDAA 

#$20 

,SEND  SPACE 

JMP 

SETOUT 

OUTDATA: 

LDX 

SCRTCH3 

,GET  ADDR  POINTER 

LDAA 

0,X 

,TO  GET  DATA  BYTE 

PSHA 

,SAVE 

LDD 

#DECLEN 

STD 

VECT2 

,PREP  XIT  VECTOR 

PULA 

.RETRIEVE  DATA  BYTE 

.IMP 

OUTBYTE 

,&  SEND  IT 

> 

DECLEN: 

LDD 

#DECLEN2 

,EXIT  FROM  OUTBYTE2.. 

JMP 

XSET 

DECLEN2: 

LDX 

SCRTCH1 

,GET  LENGTH 

DEX 

.DECREMENT 

STX 

SCRTCH1 

,&  RETURN 

BNE 

SAYMORE 

,  MORE  DATA? 

JMP 

PROMPT 

.PROMPT  IF  DONE 

SAYMORE: 

LDX 

SCRTCH3 

,GET  ADDR 

INX 

.INCREMENT 

STX 

SCRTCH3 

.REPLACE 

XGDX 

,X  REG  TO  ACCD 

LSRD 

,LSB  TO  C 

BCS 

OUTDATA 

.NEXT  BYTE  NOW  IF  ODD 

ANDB 

#$07 

.CHECK  FOR  XXXO  (LINE  END) 

BNE 

SENDSP 

,IF  ONLY  EVEN,  SEND  SP 

» 

LDAA 

#';' 

,IF  NEW  LINE,  SEND  CONTINUE 

JSR 

GENPAR 

STAA 

SCDR 

LDD 

#OUTLINE 

,&  PREP  FOR  NEW  LINE.. 

JMP 

XSET 

endif 

;    OUTPUTS  A  BYTE  IN  A  AS  TWO  HE  J 

C  CHARS,  EXITS  VIA  VECT2.. 

OUTBYTE: 

STAA 
LSRA 

SCRTCH5 

,STASH  FOR  LATER 

LSRA 

,MOVE  OVER 

LSRA 

LSRA 

JSR 

HEXASC 

,CONVERT 

PSHA 

,AND  SAVE.. 

LDD 

#OUTBYT2 
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OUTBYT2: 


STD  XVECT 

PULA 

JMP  SETOUT 

LDAA  SCRTCH5 

ANDA  #$0F 

JSR  HEXASC 

JMP  OUTJMP 


;RECOVER  CHARACTER 

;CLEAN  UP 

;CONVERT,  SEND  &  JUMP  THRU  VECT2 


SEND  A  PROMPT  FROM  THE  MONITOR,  THEN  WAIT  FOR  CHARS 

PROMPT:  LDX  #PLIST 

JMP  TTYO 

PLIST:  FCB  $0D,$0A,':\$EE,$90,SCRTCH1,$AA 

FDB  PJUMP 

PJUMP:  LDAA  SCRTCH1 

JMP  CONCHAR 


INITIATE  AN  OUTPUT  SEQUENCE 


SETOUT:  JSR         GENPAR 

STAA     SCDR 
BSET      SCCR2,$C0 
&  LDAA  SCCR2 

ORAA  #$C0 

STAA  SCCR2 

LDD       #ECHO 
JMP        RSET 


;SEND  FIRST  CHAR 


;TURN  ON  INTERRUPTS  IF  REQ'D 


;&  PREPARE  TO  ECHO 


;    SENDS  ETX  &  CARRIES  ON  THRU  VECT2 

XETX:                  LDAA    #$03 

,SEND  ETX 

OUTJMP:             JSR        GENPAR 

,MAY  ENTER  HERE... 

STAA     SCDR 

.DRAGON  AGAIN? 

JMP        JUMP2 

,NOW  THRU  JUMP2 

1ft********************************************************** 


SUBROUTINES  USED  BY  PTR  DRIVER 


ATTN: 


ATTN1: 


ATTN2: 


LDAA 

PORTA 

GET  THE  VALUE  IN  PORT  A 

CMPA 

#DB00 

IS  0  DB  SET? 

BNE 

ATTN1 

IF  NO  GO  ON 

LDAA 

#DB03 

IF  YES  SET  3  DB 

STAA 

PORTA 

BRA 

ATTNF 

EXIT 

CMPA 

#DB03 

IS  3  DB  SET? 

BNE 

ATTN2 

IF  NO  GO  ON 

LDAA 

#DB09 

IF  YES  SET  9  DB 

STAA 

PORTA 

BRA 

ATTNF 

EXIT 

CMPA 

#DB12 

IS  12  DB  SET? 

BNE 

ATTN3 

IF  NO  GO  ON 
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ATTN3: 


ATTN4: 


ATTN5: 

ATTN6: 
ATTNF 
INC: 


INC1: 


INC2: 


INC3: 


INC4: 


INC5: 
INCF 


LDAA 

#DB18 

STAA 

PORTA 

BRA 

ATTNF 

CMPA 

#DB18 

BNE 

ATTN4 

LDAA 

#DB24 

STAA 

PORTA 

BRA 

ATTNF 

CMPA 

#DB24 

BNE 

ATTN5 

LDAA 

#DB30 

STAA 

PORTA 

BRA 

ATTNF 

CMPA 

#DB30 

BNE 

ATTN6 

BRA 

ATTNF 

LDAA 

#DB00 

STAA 

PORTA 

RTS 

LDAA 

PORTA 

CMPA 

#DB30 

BNE 

INC1 

LDAA 

#DB24 

STAA 

PORTA 

BRA 

rNCF 

CMPA 

#DB24 

BNE 

INC2 

LDAA 

#DB18 

STAA 

PORTA 

BRA 

PNCF 

CMPA 

#DB18 

BNE 

INC  3 

LDAA 

#DB12 

STAA 

PORTA 

BRA 

INCF 

CMPA 

#DB12 

BNE 

INC4 

LDAA 

#DB09 

STAA 

PORTA 

BRA 

INCF 

CMPA 

#DB09 

BNE 

INC  5 

LDAA 

#DB03 

STAA 

PORTA 

BRA 

INCF 

LDAA 

#DB00 

STAA 

PORTA 

RTS 

;IF  YES  SET  18  DB 

EXIT 

IS  18  DB  SET? 

IF  NO  GO  ON 

IF  YES  SET  24  DB 

EXIT 

IS  24  DB  SET? 

IF  NO  GO  ON 

IF  YES  SET  30  DB 

EXIT 

IS  30  DB  SET? 

IF  NO  GO  ON 

IF  YES  CANT  CHANGE  ANYMORE 

IF  NON  OF  THE  ABOVE  ARE  SET,  SET  0  DB 


GET  THE  VALUE  IN  PORT  A 

IS  30  DB  SET? 

IF  NO  GO  ON 

IF  YES  SET  24  DB 

EXIT 

IS  24  DB  SET? 
IF  NO  GO  ON 
IF  YES  SET  18  DB 

EXIT 

IS  18  DB  SET? 

IF  NO  GO  ON 

IF  YES  SET  12  DB 

EXIT 

IS  12  DB  SET? 
IF  NO  GO  ON 
IF  YES  SET  9  DB 


IS  9  DB  SET? 
IF  NO  GO  ON 
IF  YES  SET  3  DB 


;IF  NON  OF  THE  ABOVE  ARE  SET,  SET  0  DB 


.****************4^****************************************** 
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SUBROUTINES  USED  BY  SAIL  DRIVER. 


Converts  low  nibble  in  A  to  ASCII  char  in  A 

HEXASC:  ANDA  #$0F  ;CLEAN  IT  UP 

ADDA  #$F6 

BCC  HNUMBER 

ADDA  #$07  .CONVERT 

HNUMBER:         ADDA  #$3A  ;  TO  ASCII 

RTS 


;   Converts  ASCII  char  in  A  to  nibble  in  A  if  it  is  HEX  &  clears  C 

;              Otherwise,  returns  origional  char  with  C  bit  set. 

ASCHEX: 

PSHA 

;SAVE  CHAR 

SUBA 

#$30 

BCS 

NOTHEX 

SUBA 

#$0A 

BGE 

TSTALPH 

ADDA 

#$0A 

;REPAIR  NUMB 

BRA 

AXIT 

TSTALPH: 

SUBA 

#$07 

;41->00  ? 

BLT 

NOTHEX 

SUBA 

#$06 

BGE 

NOTHEX 

ADDA 

#$10 

;REPAIR  ALPH 

AXIT: 

INS 

;POP  OFF  SAVED  CHAR 

CLC 

;AND  CLEAR  CARRY  BIT 

RTS 

NOTHEX: 

PULA 

;GET  CHAR 

SEC 

;SET  CARRY 

RTS 

GENERATE  PARITY-  Char  is  passed  in  and  out  thru  A 


GENPAR: 


PSHB 

PSHX 

TAB 

LDX 

ABX 

ORAA 

PULX 

PULB 

RTS 


#PARITY 


0,X 


;SAVE  SOME  STUFF- 
COPY  CHAR  TO  B 
POINT  TO  PARITY  TABLE  TOP 
ADD  OFFSET  TO  POINT  X  TO  CHAR 
ADD  PARITY  BIT 
..RESTORE 


PARITY  TABLE 


PARITY: 


;XX20 


FCB  $00,$80,$80,$00,$80,$00,$00,$80  ;A 

FCB  $80,$00,$00,$80,$00,$80,$80,$00  ;B 

FCB  $80,$00,$00,$80,$00,$80,$80,$00  ;B 

FCB  $00,$80,$80,$00,$80,$00,$00,$80  ;A 

FCB  $80,$00,$00,$80,$00,$80,$80,$00  ;B 
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;XX40 


;XX60 


;XX80 


:XXAO 


;  XXCO 


;  XXEO 


fcb  soo.sso.sso.soo.sso.soo.soo.sso 

FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 

FCB  $80,$00,$00,$80,$00,$80,$80($00 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 

FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 

FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 

FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 

FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 

FCB  $80,$00,$00,$80,$00,$80,$80,$00 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 
FCB  $00,$80,$80,$00,$80,$00,$00,$80 

fcb  sso.soo.soo.sso.soo.sso.sso.soo 


CHARACTER   LOOKUP  TABLE 
CHARTBL:  FCB  $41,$42,$43,$44,$45,$46,$47,$00 

FCB  $00,$00,$00,$00,$00,$00,$00,$00 
FCB  $49,$4A,$4B,$4C,$4D,$4E,$50,$00 
FCB  $00,$00,$00,$00,$00,$00,$00,$00 
FCB  $51)$52,$53,$54,$55,$56,$57,$00 
FCB  $00,$00,$00,$00,$00,$00,$00,$00 
FCB  $59,$5A,$5B;$5C,$5D,$5E,$5F,$75 
FCB  $00,$00,$00,$00,$00,$00,$00,$00 
FCB  $61,$62,$63,$64,$65,$66,$68,$74 
FCB  $00,$00,$00,$00,$00,$00,$00,$00 
FCB  $69,$6A,$6B,$6C,$6D,$6E,$70,$74 
FCB  $00,$00,$00,$00,$00,$00,$00,$00 
FCB  $71,$72,$73,$74,$75,$76,$77,$72 
FCB  $00,$00,$00,$00,$00,$00,$00,$00 
************************************************************ 


00-07 
08-OF 
10-17 
18-1F 
20-27 
28-2F 
30-37 
38-3F 
40-47 
48-4F 
50-57 
58-5F 
60-67 
68-6F 


178 


;   HELP  FILE  DUMP 

SAYHELP:           LDX 

#HELPFIL 

BRA 

TTYO 

A  TTY  ROUTINE  FOR  SAIL68  **DO  NOT  DELETE!  USED  BY  PROMPT  ETC!** 
-USES  $FD  BYTES 

-TO  ENTER  FOR  XMIT,  LDX  #table  AND  THEN  JMP  TTYO 
-TO  ENTER  IN  REC  MODE  LDX  Stable  AND  JMP  TTYRO 
-MUST  USE  EE  TO  SWITCH  FROM  SENDING  TO  REC  CHARS 
-CAN  GO  BACK  TO  SENDING  W/O  PROBLEM 
-ARG  TABLE  CODES.. 

ASCII     -TYPE  IT  AND  GO  ON  WITH  XMIT  INTERRUPTS  ON 

00  -BACK  TO  THE  PROMPT 

AA  aaaa  -JMP  TO  aaaa  WITH  XMIT  INTERRUPTS  STILL  ON  (USE  FDB!) 

80  aa      -SEND  CHAR  AT  LOC  aa 

81  aa      -SEND  HEX  PAIR  AT  LOC  aa 

EE  -SEND  ETX  &  WAIT  FOR  A  CHAR  (MUST  BE  FOLLOWED  BY  9X) 

90  aa      -REC  A  CHAR  AND  SAVE  IT  AT  aa 

91  aa      -REC  A  HEX  PAIR  AND  SAVE  IT  AT  aa  (ABORT  TO  PROMPT  <>HEX) 
94  aa      -CLEAR  SCRTCH1.2  &  WAIT  FOR  A  HEX  STRING,  PUT  AT  aa,aa+l 

(ENTRY  TERMINATED  BY  SP  OR  CR) 


;LOAD  X  FROM  STORAGE  LOCATION 
;SET  REENTER  VECTOR 


TTY: 

LDX 

XTTY 

TTYO: 

LDD 

#TTY 

STD 

XVECT 

LDAA 

00,X 

BNE 

TRYAA 

JMP 

PROMPT 

TRYAA: 

CMPA 

#$AA 

BNE 

TRYASC 

INX 

LDX 

0,X 

JMP 

0,X 

TRYASC: 

TSTA 

BMI 

TRY80 

JSR 

LBISX 

TBA 

JMP 

SETOUT 

TRY80: 

CMPA 

#$80 

BNE 

TRY81 

INX 

JSR 

LBISX 

JSR 

CRADDR 

LDAA 

0,X 

JMP 

SETOUT 

> 

TRY81: 

CMPA 

#$81 

BNE 

TRYEE 

;GET  ARGUMENT 

;IF  =00,  GO  DIRECTLY  TO  PROMPT. 


.VECTOR  TO  X 
;AND  JUMP  TO  M(X) 


JFMSB  IS  1,  NOT  ASCII.. 

;ELSE  GET  THE  ASCII  IMM  CHAR 


;GO  SEND  IT  NOW 
;REQ  IND  CHAR? 


GET  THE  ADDRESS  (ASSUME  BASE  PAGE) 
CREATE  ADDRESS 
GET  THE  IND  DATA 


;REQ  IND  HEX  PAIR? 
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INX 

JSR  LBISX 

JSR  CRADDR 

LDD  #TTY2 

STD  VECT2 

LDAA  0,X 

JMP  OUTBYTE 


GET  THE  ADDRESS  (ASSUME  BASE  PAGE) 

CREATE  ADDRESS 

THEN  SET  UP  VECT2  EXIT  PATH 

;GET  THE  IND  DATA  NOW 


TTY2: 


TRYEE: 

TRERR: 
PROMPT 


LDD 

JMP 


#TTY 
XSET 


CMPA    #$EE 
BEQ       GOTEE 
JMP        PROMPT 


;EXIT  PATH  FOR  VECT2  STUFF.. 
.(ALLOWS  OUTBYTE  TO  RETURN  TO  TTY) 

;SEND  ETX  &  GO  TO  RECEIVE  MODE? 

;IF  NOT  VALID  OUT  GROUP  CONTROL  CHAR,  JUST 


GOTEE: 


INX 

STX 

LDAA 

JSR 

STAA 

BCLR 

LDD 

JMP 


XTTY 

#$03 

GENPAR 

SCDR 

SCCR2,$C0 

#TTY3 

RSET 


SWITCH  TO  INPUT  MODE 

SAVE  THE  CONTROL  TABLE  POINTER 

SEND  ETX 


,STOP  FURTHER  XMIT  INTERRUPTS 

;  AND  PREPARE  TO  RECEIVE  THE  ETX  ECHO 


TTY3: 


CMPA    #$03 
BEQ       TTY4 
JMP        SCIXIT 


;GOT  ETX  YET? 

;  KEEP  WAITING  TILL  IT  ECHOS 


TTY4: 


LDD 

JMP 


#TTYR 
RSET 


;WHEN  GOT  ETX,  PREP  TO  REC  DATA  CHARS 
;  SET  RVECT  TO  TTYR  AND  EXIT 


;  TTY  RECEIVE  SECTION,  ENTER  HERE  FROM  COMMAND  CHAIN  W/O  NEW  CHAR 
TTYRO:  STX        XTTY  ;JUST  SAVE  TABLE  POINTER 

BRA       TTY4  :  AND  GO  GET  A  NEW  CHAR 


;   ENTER  HERE  FROM  RVECT  WITH  DATA  CHAR  IN  A 


TTYR: 

LDX 

XTTY                   ; 

JSR 

LBISX                  ; 

TRY90: 

CMPB 

#$90                     ; 

BNE 

TRY91 

SAVCHR: 

JSR 

LBISX                  ; 

JSR 

CRADDR             ; 

STAA 

0,X                       ; 

BRA 

CKNEXT 

WRITE) 

TRY91: 

CMPB 

#$91 

BNE 

TRY94 

JSR 

ASCHEX 

BCS 

TRERR 

WHILE  WE  FIGURE  OUT  WHAT  TO  DO  WITH  IT 
GET  THE  CONTROL  CHAR.. 
SAVE  WHOLE  CHAR 

IF  90,  SAVE  WHOLE  CHAR  AT  IMM  ADDRESS 

CREATE  ADDRESS 

SAVE  THE  DATA  BYTE  IN  M(X) 

CHECK  NEXT  CONTROL  BYTE  FOR  TYPE  (READ  OR 


ENTER  A  HEX  PAIR? 


ABORT  IF  NOT  HEX  CHAR 


180 


ASLA 

ASLA 

ASLA 

ASLA 

STAA     SCRTCH1 

LDD       #TTYHEX 

JMP        RSET 


;MOVE  OVER 


;SAVE  TILL  NEXT  PASS 
;PREP  FOR  2ND  HEX  CHAR 


TTYHEX: 


JSR 

BCS 

ORAA 

LDX 

JSR 

JSR 

STAA 

LDD 

STD 

BRA 


ASCHEX 

TRERR 

SCRTCH1 

XTTY 

LBISX 

CRADDR 

o,x 

#TTYR 
RVECT 
CKNEXT 


(  SECOND  HALF  OF  TRY91  ) 
ABORT  IF  NOT  A  VALID  HEX  CHAR 
COMBINE  HIGH  AND  LOW  CHARS 

;GET  SINK  ADDRESS 
;CREATE  ADDRESS 

;REPAIR  THE  VECTOR 

;  AND  ON  TO  CHECK  NEXT  COMMAND 


TRY94: 
GOT94: 


SAVE4: 


CMPB 

BNE 

CLR 

CLR 

PSHA 

LDD 

STD 

LDD 

STD 

PULA 

JMP 

LDD 

STD 

LDX 

JSR 

JSR 

LDD 

STD 

BRA 


#$94 
TRERR 
SCRTCH1 
SCRTCH2 

#SAVE4 
VECT2 
#IN4HEX 
RVECT 

IN4HEX 

#TTYR 

RVECT 

XTTY 

LBISX 

CRADDR 

SCRTCH1 

0,X 

CKNEXT 


IS  IT  IN4? 

QUIT  IF  NOT  A  VALID  CODE 

GOT  FIRST  DIGIT  IN  A,  CLEAR  INPUT  BUFFER 

;SAVE  THE  ARGUMENT 

;PREPARE  EXIT  VECTOR 

.CHANGE  RVECT 

;AND  PROCESS  THE  FIRST  DIGIT 


REPAIR  THE  VECTOR 

GET  THE  TABLE  POINTER 

AND  GET  THE  SINK  ADDRESS 

CREATE  ADDRESS 

AND  STORE  THE  DOUBLE  BYTE 

;CHECK  NEXT  CONTROL  CHAR 


CKNEXT: 


LDX       XTTY 
LDAA    0,X 
ANDA    #$F0 
CMPA    #$90 
BNE       TTYOL 
JMP        SCIXIT 


IS  THE  NEXT  CONTROL  CHAR  AN  INP  OR  OUT? 
GET  THE  CONTROL  CHAR 
AND  CHECK  THE  HIGH  NIBBLE 
IS  IT  AN  INPUT  TYPE? 
IF  NOT,  SWITCH  TO  OUTPUT  MODE 
ELSE  GET  ANOTHER  CHAR 


TTYOL: 
LBISX: 


JMP        TTYO 

LDAB    0,X 
INX 


•.SUBROUTINE  TO  LOAD  B,  INC  &  STR  X 
;  USED  BY  TTY  ABOVE 
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STX 
RTS 


XTTY 


CRADDR: 


LDX       #$0000 

ABX 

RTS 


-.SUBROUTINE  TO  CREATE  AN  ADDRESS 


;   AFTER  VALID  ADDRESS,  RECEIVE  CONTROL  CHAR.. 

;CLEAN  OFF  FLAG  BIT 
;IS  IT  T 


CONCHAR: 


GOMON 

SAYHEL 

DSCANL 

TIME.!: 

TIMOUTJ: 

RSTARTJ: 

AVOUT.T: 


SETBG: 
SETQG: 
ATTCMD: 

BGROUP: 


ANDA 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

JMP 

JMP 
.IMP 
JMP 
JMP 
JMP 
JMP 
JMP 

LDD 
JMP 
LDD 
JMP 
LDD 
JMP 


#$7F 

SETBG 

#'?• 

SETQG 

WO' 

TIMEJ 

tt'P' 

TIMOUTJ 

DSCANL 

#7V 

ATTCMD 

#" 

GOMON 

#$0D 

GOMON 

#'H' 

SAYHEL 

#'R' 

RSTARTJ 

#'V 

AVOUTJ 

SETUNAD 

PROMPT 

SAYHELP 

DSCAN 

TIME 

TIMOUT 

START 

AVOUT 

#BGROUP 

RSET 

#QGROUP 

RSET 

#ATTNGRP 

RSET 


OR  IS  IT  '?' 

IS  IT  *0\  START  DATA  COLLECTION? 

IS  IT  P\  PAUSE  DATA  COLLECTION? 

IS  IT  '-*,  DATA  SCAN  REQUEST? 

IS  IT7V,  SET  GAIN  CONTROL? 

SPACE  TO  ENTER  MONITOR? 

CHAR  RETURN  TO  ENTER  MONITOR? 

HELP? 

RESTART? 

ATTEN  VALUE  REQUEST 

UNADDRESS  IF  NOT  VALID.. 

LINK  INTO  MONITOR 

LINK  TO  SAYHELP 

LINK  TO  DATA  SCAN 

LINK  TO  TIME 

LINK  TO  TIMOUT 

LINK  TO  START 

LINK  TO  ATTEN  VAL  OUTPUT 

PREPARE  FOR  THE  CHAR  AFTER  ! 

PREPARE  FOR  THE  CHAR  AFTER  ? 

PREPARE  FOR  THE  CHAR  AFTER  A 


NOP 

CMPA    #T 
BEQ       LTESTJ 
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BANGML: 

LTESTJ: 
QGROUP: 


QUERYML: 


ATTNGRP: 


SETODBJ 
SET1DB.T 
SET2DBJ 
SET3DBJ 
SET4DBJ 
SET5DBJ 


if  LOAD 

CMPA  #'M' 

BEQ  BANGML 
endif 

JMP  PROMPT 

if  LOAD 

JMP  BANGM 
else 
endif 


JMP 


LTEST 


NOP 

if  VIEW 

CMPA    #'M' 

BEQ       QUERYML 

else 

endif 

JMP        PROMPT 


if 

JMP 
else 
endif 


NOP 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

CMPA 

BEQ 

JMP 

JMP 
JMP 
JMP 
JMP 
JMP 
JMP 


VIEW 
QUERYM 


#'0' 

SETODBJ 

U'V 

SET1DBJ 

ti'T 

SET2DBJ 

#'3' 

SET3DBJ 

#T 

SET4DBJ 

#'5' 

SET5DBJ 

#'6' 

SET6DBJ 

#7V 

AGCONJ 

PROMPT 

SETODB 

SET03DB 

SET09DB 

SET12DB 

SET18DB 

SET24DB 


;LINK  TO  !M 


;LINK  TO  ?M 


;MANUAL  SET  0  DB  ATTEN 
;MANUAL  SET  3  DB  ATTEN 
;MANUAL  SET  9  DB  ATTEN 
;MANUAL  SET  12  DB  ATTEN 
;MANUAL  SET  18  DB  ATTEN 
;MANUAL  SET  24  DB  ATTEN 
;MANUAL  SET  30  DB  ATTEN 
;SET  AGC  ON 


LINK  TO 
LINK  TO 
LINK  TO 
LINK  TO 
LINK  TO 
LINK  TO 


SETODB 

SET3DB 

SET09DB 

SET12DB 

SET18DB 

SET24DB 
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SET6DBJ: 
AGCONJ: 


JMP 
JMP 


SET30DB 
AGCON 


;LINK  TO  SET30DB 
;LINK  TO  AGCON 


;PAUSE  REQUEST 

TIMOUT:  CLR  TMSK1 

LDAA  #$FF 

STAA  TFLG1 

JMP  PROMPT 


STOPS  THE  DATA  DUMP 
;DISABLE  TOC2  INTERUPT 
;RESET  TOC  FLAGS 

;RETURN 


;START  REQUEST 

TIME:  LDD  TCNT 

ADDD  U  SAMPLE 

STD  DTOC2 

LDAA  #$40 

STAA  TMSK1 

JMP  PROMPT 


TURN  ON  TIMER  INTERUPT 
;LOAD  THE  CURRENT  TIMER  VALUE 
;SET  AN  INITIAL  DELAY  OF  l.OmSEC 

;TURN  ON  OC2  INTERUPT 

;RETURN 


; DATA  SCAN 
DSCAN: 

DSCANO: 

DSCAN1: 

NOTYET: 

NOTRDY: 

DSCAN2: 


DSCAN3: 
DSCAN4: 


DSCAN5: 


LDX 
JMP 
DB 
DW 


#DSCAN0 
TTYO 
$AA 
DSCAN1 


BRCLR  TX1FLG,$01,DSCAN2  ;HAS  BUFFER  1  BEEN  SENT  YET? 
BRCLR  TX2FLG,$01,DSCAN3  ;HAS  BUFFER  2  BEEN  SENT  YET? 
LDX       #NOTRDY  ;WAIT  UNTIL  A  BUFFER  IS  READY 

JMP        TTYO 
FCB        $00,$00 


BSET 

LDX 

BRA 

BSET 

LDX 

STX 

LDAB 

ABX 

STX 

LDY 
STY 

LDAA 
STAA 
LDAA 
STAA 
LDAA 
STAA 
LDAA 
STAA 


TX1FLG,$01 

#MAXBUF1 

DSCAN4 

TX2FLG,$01 

#MAXBUF2 

TXBUFF 

MAXNUM 

TXBFULL 

TXBUFF 

TXINT 

$00,Y 

TXMHI 

$01, Y 

TXMLO 

$10,Y 

TXIHI 

$11,Y 

TXILO 


;SET  BUFFER  1  TX'D  FLAG 

;SET  BUFFER  2  TX'D  FLAG 

;SAVE  THE  BUFFER  TO  TX  IN  TXBUFF 

iGENERATE  THE  BUFFER  DONE  VALUE 


GET  THE  DATA  POINT  HI  BYTE 

STORE  IN  BASE  PAGE 

GET  THE  DATA  POINT  LOW  BYTE 

STORE  IN  BASE  PAGE 

GET  THE  INDEX  HI  BYTE 

;GET  THE  INDEX  LOW  BYTE 


LDX       #BITSND1 


;PREP  FOR  TX 


184 


.IMP 

TTYO 

;TX  DATA  POINT 

BITSND1: 

DB 

$81,TXMHI,$AA 

;TX  VIA  TTY 

DW 

DTX1 

DTX1: 

LDX 

#BITSND2 

;PREP  FOR  TX 

JMP 

TTYO 

;TX  DATA  POINT 

BITSND2: 

DB 

$81,TXMLO,$AA  ;TX  VIA  TTY 

DW 

DTX2 

DTX2: 

LDX 

#BITSND3 

;PREP  FOR  TX 

.IMP 

TTYO 

;TX  DATA  POINT 

BITSND3: 

DB 

$81,TXIHI,$AA 

;TX  VIA  TTY 

DW 

DTX3 

DTX3: 

LDX 

#BITSND4 

;PREP  FOR  TX 

JMP 

TTYO 

;TX  DATA  POINT 

BITSND4: 

DB 

$81,TXILO,$AA 

;TX  VIA  TTY 

DW 

DSCAN6 

> 

DSCAN6: 

LDY 
INY 
INY 

TXINT 

STY 

TXINT 

CPY 

TXBFULL 

;HAS  THE  ENTIRI 

BLO 

DSCAN5 

» 

LDAA 

#$00 

LDX 

TXBUFF 

;CLEAR  THE  BUF 

DSCAN7: 

STAA 
INX 

$00,X 

CPX 

TXBFULL 

BLO 

DSCAN7 

» 

LDX 

#DSCAN8 

;ENDTX 

JMP 

TTYO 

DSCAN8: 

DB 

$00,$00 

LTEST: 

LDX 

#RTEST 

JMP 

TTYRO 

RTEST: 


DB  $94,$80,"  GOT  4!  SEND  4  MORE",$EE,$94,$84,"DONE",$00,$00 


0  DB  MANUAL  GAIN  REQUEST 
SETODB:  BSET     AGCFLG,$01 

LDAA    #DB00 
STAA     PORTA 
JMP        PROMPT 


;TURN  OFF  AGC 

;SET  0  DB  ATTENUATION 

;RETURN 


;3  DB  MANUAL  GAIN  REQUEST 
SET03DB:  BSET     AGCFLG,$01 

LDAA    #DB03 
STAA     PORTA 
JMP        PROMPT 


;TURN  OFF  AGC 

;SET  3  DB  ATTENUATION 

;RETURN 
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;9  DB  MANUAL  GAIN  REQUEST 
SET09DB:  BSET     AGCFLG,$01 

LDAA    #DB09 
STAA     PORTA 
JMP        PROMPT 


JURN  OFF  AGC 

;SET  9  DB  ATTENUATION 

;RETURN 


;12  DB  MANUAL  GAIN  REQUEST 
SET12DB:  BSET     AGCFLG,$01 

LDAA    #DB12 
STAA     PORTA 
JMP        PROMPT 


;TURN  OFF  AGC 

;SET  12  DB  ATTENUATION 

;RETURN 


;18  DB  MANUAL  GAIN  REQUEST 
SET18DB:  BSET     AGCFLG,$01 

LDAA    #DB18 
STAA     PORTA 
JMP        PROMPT 


;TURN  OFF  AGC 

;SET  18  DB  ATTENUATION 

;RETURN 


;24  DB  MANUAL  GAIN  REQUEST 
SET24DB:  BSET     AGCFLG,$01 

LDAA    #DB24 
STAA     PORTA 
JMP        PROMPT 


JURN  OFF  AGC 

;SET  24  DB  ATTENUATION 

iRETURN 


;30  DB  MANUAL  GAIN  REQUEST 

SET30DB:            BSET 

AGCFLG,$01 

JURN  OFF  AGC 

LDAA 

#DB30 

;SET  30  DB  ATTENUATION 

STAA 

PORTA 

.IMP 

PROMPT 

;RETURN 

;AGC  ON  REQUEST 

AGCON:              CLR 

AGCFLG 

;SET  AGC  ON  FLAG  TO  0  Q 

JMP 

PROMPT 

;RETURN 

AVOUT:  LDX       tfAVODAT 

JMP        TTYO 
AVODAT:  DB  $81,PORTA,$00,$00 

JMP        PROMPT 

************************************************************ 


HELP  FILE 
HELPFIL 


:FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 

FCB 


elp  SAIL  DRIVER  Mon,  Jun  7,  1993,  11:53*,$0D,$0A 

Monitor  Commands  (enter  via  _  or  ?  or  !)',$0D,$0A 

_  (space)  enter  monitor*',$0D,$0A 
?Maaaa_llllcr  *',$0D,$0A 
!Maaaa_dd...cr  *\$0D,$0A 

Attenuator  Commands  (enter  via  A)',$0D,$0A 
A0  sets   0  dB  manual  attenuation',$0D,$0A 
Al  sets   3  dB  manual  attenuation',$0D,$0A 
A2  sets   9  dB  manual  attenuation',$0D,$0A 
A3  sets  12  dB  manual  attenuation',$0D,$0A 
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FCB  '   A4  sets  18  dB  manual  attenuation',$OD,$OA 

FCB  '   A5  sets  24  dB  manual  attenuation\$OD,$OA 

FCB  '   A6  sets  30  dB  manual  attenuation',$0D,$0A 

FCB  '   AA  turns  AGC  on\$0D,$0A 

FCB  'O  starts  receiver  collecting  samples',$0D,$0A 

FCB  'P  pauses  receiver\$0D,$0A 

FCB  'R  resets  the  system',$0D,$0A 

FCB  'with  all  RCA  UT4  conventions',$0D,$0A 

FCB  '  *  returns  prompt\$00 

.**+****************«-******♦****♦*******+♦♦*********#*««***** 

ORG  $FFD6 

VSCI:  FDB  SCI 

VSPI:  FDB  START 

VPAIE:  FDB  START 

VPAO:  FDB  START 

VTOF:  FDB  START 

VTOC5:  FDB  START 

VTOC4:  FDB  START 

VTOC3:  FDB  START 

VTOC2:  FDB  OC2 

VTOC1:  FDB  START 

VTIC3:  FDB  START 

VTIC2:  FDB  START 

VTIC1:  FDB  START 

VRTI:  FDB  START 

VIRQ:  FDB  START 

VXIRQ:  FDB  START 

VSWI:  FDB  START 

VILLOP:  FDB  START 

VCOP:  FDB  START 

VCLM:  FDB  START 

VRST:  FDB  START 

END 
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Appendix  3 

This  appendix  contains  the  C  source  code  use  by  the  Macintosh  computer  for 
the  algorithm  of  figure  2-4.    The  user  interface  follows  the  guidelines  specified  by 
Apple,  and  the  Event  Manager  is  used  to  initiate  all  functions.    After  the  hardware  is 
initialized,  the  program  waits  in  the  EventLoop  until  an  event  is  received.    If  no  events 
are  received  in  the  loop  cycle  time,  the  program  requests  data  from  the  68HC11  and 
the  GPS  receiver.    If  the  data  is  available,  it  is  stored  to  form  experiment  vectors. 
Once  enough  experiment  vectors  are  collected,  the  maximum  likelihood  estimate  is 
calculated.    The  program  the  returns  to  the  EventLoop. 

TRACKER.C 

Dennis  Michael  Wojcik 
15  July  1993 

This  program  is  version  1.0  of  the  Precision  Tracking  Receiver.    It  is  tailored 
for  the  scenario  of  a  stationary  acoustic  beacon  and  a  moving  observer.    The 
program  assumes  that  the  observer  has  a  GPS  receiver  for  positioning  data 
that  can  produce  a  fix  at  least  every  2  seconds.    If  a  different  navigation 
system  is  used  to  provide  ship  locations,  it  is  up  to  the  user  to  provide 
the  proper  position  format: 

?L  HHMMSS,DDMM.hh,N,DDDMM.hh)E,x,x,DOP,xxx)M,xxxxx,M 

/***************************  INCLUDES  ***♦************♦****♦******************/ 

//include  <math.h>  //  needed  for  math  calls 

//include  <AppleEvents.h>  //  needed  to  handle  AppleEvents 

//include  <GestaltEqu.h>  //  needed  to  read  system  7  AppleEvents 

//include  <Values.h>  //  contains  needed  Mac  constants 

//include  <serial.h>  //  has  needed  serial  comms  constants 

//include  <Packages.h>  //  needed  to  call  time  functions 

//include  <string.h>  //  needed  to  call  string  functions 

//include  <float.h>  //  contains  needed  constants 

//include  <stdlib.h>  //  for  standard  calls  such  as  strtoul  etc 

//include  <stdio.h>  //  usefull  for  debugging 

/ft****************************************************************************/ 
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/**********************+**** 


DEFINES  *********************************♦*******/ 


^define  kBaseResID 

128 

#define  kMoveToFront 

(WindowPtr)-lL 

fldefine  kUseDefaultProc 

(void  *)-lL 

#define  kSleep 

1L 

#define  kLeaveWhereltls 

false 

tfdefine  mApple 

kBaseResID 

^define  iAbout 

1 

tfdefine  mFile 

kBaseResID+1 

#define  iQuit 

1 

fldefine  mAttenuator 

kBaseResID+3 

fldefine  iAuto 

1 

#define  iOdB 

2 

#define  i3dB 

3 

fldefine  i9dB 

4 

fldefine  il2dB 

5 

fldefine  il8dB 

6 

tfdefine  i24dB 

7 

^define  i30dB 

8 

fldefine  mBaud 

kBaseResID+4 

#define  i300 

1 

fldefine  i600 

2 

fldefine  il200 

3 

#define  i2400 

4 

tfdefine  i4800 

5 

#define  i9600 

6 

#define  mSignal 

kBaseResID+5 

#deFme  iPeriod 

1 

fldefine  iNumMax 

2 

fldefine  iWindow 

3 

#define  iMessageText 

4 

#define  kPeriodDialog 

kBaseResID 

#define  kNumMaxDialog 

kBaseResID+1 

#deFine  kWindowDialog 

kBaseResID+2 

#define  kLeftMargin 

4 

#define  kFontSize 

10 

fldefine  kRowHeight 

(kFontSize+2) 

#define  kDataScanHeight 

1 

#define  kHorizontalOffset 

0 

#deFine  kGestaltMask 

1L 

#define  kHorizontalPix 

30 

#define  kVerticalPix 

40 

#define  kMinWindowHeight 

50 

#deFine  kMinWindowWidth 

80 

#deFine  kMinTextPosition 

0 

//  deFine  general  resource  infor 


//  Apple  menu  resource  ID 


//  File  menu  resource  ID 


//  Attenuator  menu  resource  ID 


//  Baud  Rate  menu  resource  ID 


//  Signal  menu  resource  ID 


//  deFine  screen  margins 
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tfdefine  kMaxTextPosition 


32767 


#define  kScrollbarAdjust 
#define  kNormalUpdates 

(16-1) 
true 

#define  bufferSize 

1024 

#define  kl6Bit 

4 

fldefine  k8Bit 

2 

#define  kHexBase 

16 

#define  kpi 

3.141592654 

#define  kNumExp 
#define  kParameters 

6 

3 

#define  kNumMeas 

6 

#define  kStep 
fldefine  kC 

15 
1500 

#define  kMaxR 

5000.0 

#define  kMaxD 

-5000.0 

#define  kMinD 

-1.0 

#define  kxvar 

9.0 

#define  kyvar 

9.0 

#define  ktvar 

8.3333e-2 

//  define  update  constants 


//  misc.  default  values 


//  default  experiment  parameters 


I* ***#**♦**** I****************************************************************/ 
f* **************************  MACROS  ******************************************/ 

#define  TopLeft(  r  )  (*(Point  *)  &(r).top) 

#define  BottomRight(  r  )  (*(Point  *)  &(r).bottom) 

/*****************************************************************************/ 

/***************************  gloBALS  *****************************************/ 

int  gASerRefln,  gASerRefOut; 

Boolean  gDone,  gHasPopupControl,  gDataScan; 

Rect  gTrackerRect; 

int  gverticalPixels; 

int  gRowStart,  gDataRowStart,  gserConfig; 

unsigned  long  gPeriod=2000UL; 

long  gNumMax=2L,  gWindow=20L; 

char  gDataBuffer[bufferSize]; 

char  gGPSBuffer[bufferSize]= 

"L  145642,0000.00(N,00000.00,E,0>0 ,000,000  ,M,0000,M"; 

short  gLastAttn=l,  gLastBaud=6; 

Str255  gltemText; 

unsigned  long  ghorizontalPixels; 

WindowPtr  gWetPaperWind,  gTerminalWind,  gRangeWind; 

long  gPulseCounter=0L; 

long  gCheckVal=lL; 

unsigned  long  gtimel,  gtime2; 

double  gXref,  g Yref,  gX  l ,  gX2,  gY  l ,  gY2; 

Boolean  gstarter=true; 


190 


Boolean  greflag=true; 

Boolean  gDataWrap=false,  trackerStart=false; 

double  gYFact; 

unsigned  long  gt_mul,  gt_mu2; 

double  gV[kNumMeas]={kxvar,kyvar,ktvar,kxvar,kyvar,ktvar}; 


double 

gtheta[3]={  0.0,  0.0,  -. 

double 

*gw; 

double 

gxold=0.0,  gyold=0.0; 

int 

gnumlts=0; 

int 

gmu=0; 

long 

gi=0L,gnumExp=0L; 

double 

a-1-0; 

char 

gYrefString[8]; 

char 

gXrefString[9]; 

/*************************  FUNCTION  PROTOT YPES* * *  +  ****************************/ 

void  ToolBoxInit(void); 

void  Windowlnit(void); 

void  MenuBarlnit(void); 

void  Seriallnit(void); 

void  EventLoop(void); 

void  DoEvent(  EventRecord  *eventPtr  ); 

unsigned  long       HandleDataIn(int  numDataPoins); 

void  HandleMouseDown(EventRecord  *eventPtr); 

void  HandleMouseUp(EventRecord  *eventPtr); 

void  HandleMenuChoice(  long  menuChoice  ); 

void  HandleAppleChoice(  short  item  ); 

void  HandleFileChoice(  short  item  ); 

void  HandleAttenuator(short  item); 

void  HandleBaud(short  item); 

void  HandleSignal(short  item); 

unsigned  long      HandleDialog(int  dialogRes); 

void  ConcatString(Str255  strl,  Str255  str2); 

void  HandleKeyIn(  char  theChar); 

int  TalkSail(  char  theChar); 

void  Display String(int  numDataPoints); 

void  ScrollDisplay(void); 

void  HandleNull(  void  ); 

unsigned  HexCharToInt(char  Bite,int  exponent); 

int  DecIntToHexChar(int  decimal); 

void  DoUpdate(EventRecord  *eventPtr); 

int  Power(int  base,  int  exponent); 

int  DecIntToHexChar(int  decimal); 

void  ScrollDataScan(void); 

unsigned  long       DecTimeToSec(unsigned  long   timeVal); 

double  LatToY(double  latVal); 

double  LongToX(double  longVal,  double  cosfact); 

void  tracker(long  numExp); 

pascal  OSErr        SetDialogDefaultItem(DialogPtr  theDialog,  short  newltem) 
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=  {  Ox303C,  0x0304,  0xAA68}; 
pascal  OSErr        SetDialogCancelItem(DialogPtr  theDialog,  short  newltem) 

={Ox303C,  0x0305,  0xAA68}; 
pascal  OSErr        SetDialogTracksCursor(DialogPtr  theDialog,  Boolean  tracks) 

={Ox303C,  0x0306,  0xAA68}; 


/* — 

void 

{ 


-Main- 


►/ 


main(void) 

WindowPtr 

OSErr 

int 

Ptr 

char 

long 

char 


window; 

RAMOpenErr,  resetErrln,  resetErrOut,  bufSizeErr; 

SerConfig; 

serBPtr; 

serInBuffer[bufferSize]; 

numCharln,  numCharOut,  maxtime; 

addressBuf[20]; 


ToolBoxInitO; 
WindowInitO; 
MenuBarlnitO; 
SeriallnitQ; 


//  initialize  the  toolboxes 
//  set  up  the  windows 
//  draw  the  menu  bar 
//  open  the  serial  drivers 


//  ensure  we're  in  the  window 

//  open  the  RAM  Serial  Drivers 

//  if  we  can't  open  RAM  Driver  beep 


window=FrontWindowQ; 
RAMOpenErr=RAMSDOpen(sPortA); 
if  (RAMOpenErr  !=  noErr) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pProblem  opening  the  RAM  Serial  Drivers."); 

} 
gserConfig=baud9600+data8+stoplO+noParity;  //  Set  the  protocal  for  9600 

//  8  data,  1  stop,  no  parity 
resetErrIn=SerReset(gASerRefIn,gserConfig); 
resetErrOut=SerReset(gASerRefOut,gserConfig); 

if  ((resetErrln  !=  noErr)  ||  (resetErrOut  !=  noErr)) 

{ 

SysBeep(lO);  //  if  we  can't  set  the  protocal 

ScrollDisplayO;  //  beep 

DrawString("\pProblem  setting  the  serial  protocal."); 

} 

serBPtr=serInBuffer;  //  Set  the  serial  buffer  size 

bufSizeErr=SerSetBuf(gASerRefIn,serBPtr,bufferSize); 
if  (bufSizeErr  !  =  noErr) 

{ 

SysBeep(lO);  //  if  we  can't  set  the  buffer 

ScrollDisplayO;  //  size,  beep 

DrawString("\pProblem  resizing  the  serial  input  buffer."); 

} 
ScrollDisplayO; 
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numCharOut=5L;  //  see  if  we  can  talk  to  the  GPS  receiver 

FSWrite(gASerRefOut,  &numCharOut,  "#GPS  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

maxtime=TickCountO+20L; 

\vhile(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefln,&numCharIn); 
if(TickCountO  >  maxtime) 

{ 

SysBeep(lO); 

DrawString("\p  Can't  talk  to  the  GPS  reciever,  unable  to  run!!"); 
ScrollDisplayO; 
break; 
} 
} 
FSRead(gASerRefln,&numCharIn,&addressBuf); 

numCharOut=5L;  //  see  if  we  can  talk  to  the  PTR  receiver 

FSWrite(gASerRefOut,  &numCharOut,  "#PTR  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

maxtime=TickCountO+20L; 

while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO  >  maxtime) 

{ 

SysBeep(lO); 

DrawString("\p  Can't  talk  to  the  PTR  reciever,  unable  to  run!!"); 

ScrollDisplayO; 

maxtime=TickCount()+ 1 20L; 

while(TickCount()  <  maxtime) 

TickCount(); 
abortO; 
} 
} 
FSRead(gASerRefIn,&numCharIn,&addressBuf); 

TalkSail('O');  //  start  the  PTR's  data  collection 

DrawString("\p:  ");  //  display  a  cursor 

gw  =  calloc(3L*kStep*(kNumExp+l),sizeof(double));  //  get  memory  for  data 

if  (gw  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 

abortO; 

} 

EventLoopO;  //  main  execution  loop 

RAMSDClose(sPortA);  //  must  close  the  RAM  Drivers  before  shutdown 
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} 

/*■ 


free(gw); 


//  must  release  the  memory  before  shutdown 
•/ 


/* — 

void 

{ 


ToolBoxInit- 

ToolBoxInit(void) 

InitGraf(&thePort); 

InitFontsO; 

InitWindowsO; 

InitMenusO; 

TEInitO; 

InitDialogs(nil); 

InitCursorQ; 


►/ 


//  initialize  all  of  the  ToolBox 
//  Routines 


void 

{ 


Windowlnit- 

Windowlnit(void) 


WindowPtr 

short 

Boolean 


window; 
fontNum; 
update  =  true; 


//  initialize  the  display  windows 


window  =  GetNewWindow(kBaseResID,  nil,  kMoveToFront); 


if  (window  ==  nil) 

{ 

SysBeep(lO); 

ExitToShellO; 

} 

SetPort(window); 

GetFNum("\pTimes*\  &  fontNum); 

if  (fontNum  !=  0)  TextFont(fontNum); 

TextSizeflcFontSize); 


//  Couldn't  load  the  WIND  resource 

//  set  the  window  to  be  active 

//  use  Times  font 

//  use  the  default  font  size 


gverticalPixels=screenBits.bounds.bottom-screenBits.bounds.top-45; 
ghorizontalPixels=screenBits. bounds. right-screenBits.bounds. left- 10; 
gDataRowStart=gverticalPixels-2*kFontSize; 

SizeWindow(window,  ghorizontalPixels,  gverticalPixels,  update); 


ShowWindow(window); 
gWetPaperWind=FrontWindow(); 


//  activate  the  window 


gTerminalWind  =  GetNewWindow(kBaseResID+l,  nil,  kMoveToFront); 
if  (gTerminalWind  ==  nil) 
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SysBeep(lO); 
ExitToShellQ; 


//  Couldn't  load  the  WIND  resource 


/* — 
void 

{ 


} 
/*- 


/* — 

void 

{ 


SetPort(gTerminalWind); 

GetFNumC'XpTimes",  &fontNum); 

if  (fontNum  !=  0)  TextFont(fontNum); 

TextSize(kFontSize); 


//  set  the  window  to  be  active 

//  use  Times  font 

//  use  the  default  font  size 


gRowStart=gTerminalWind->portRect.bottom-2*kFontSize; 
ShowWindow(gTerminalWind); 
*/ 


MenuBarlnit 

MenuBarlnit(void) 

Handle  menuBar; 

MenuHandle        menu; 

menuBar  =  GetNewMBar(  kBaseResID  ); 
SetMenuBar(  menuBar  ); 

menu  =  GetMHandle(  mApple  ); 
AddResMenu(  menu,  'DRVR1); 

DrawMenuBarQ; 


Seriallnit 

Seriallnit(void) 

WindowPtr  window; 

OSErr  openErr,  RAMErr,  resetErr  ; 

int  serConfig; 

char  driverStringIn[]="\p.AIn"; 

char  driverStringout[]="\p.Aout"; 

window=FrontWindow(); 


*l 


II  define  system  errors 
//  define  the  port  configuration 
//  define  the  input  driver  name 
//  define  the  output  driver  name 


openErr=OpenDriver(driverStringIn,&gASerRefIn);  //  Open  the  port  A  ROM  input  serial  driver 
if  (openErr  !=  0) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pCan't  open  the  ROM  Serial  input  driver"); 

return; 
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} 

/*■ 


} 

openErr=OpenDriver(driverStringout,&gASerRefOut);  //  Open  the  port  A  ROM  output 

//serial  driver 
if  (openErr  !=  0) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pCan't  open  the  ROM  Serial  output  driver"); 

return; 
} 

gserConfig=baud9600+data8+stoplO+noParity;  //  Set  the  protocal  for 

//9600,  7D,  lS.no  parity 

resetErr=SerReset(gASerRefIn,gserConfig);  //  Set  the  input  driver  to  the  new  protocal 

if  (resetErr  !=  0) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pCan't  set  the  ROM  Serial  input  protocal"); 
return; 
} 

resetErr=SerReset(gASerRefOut,gserConfig);  //  Set  the  output  driver  to  the  new  protocal 

if  (resetErr  !=  0) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pCan't  set  the  ROM  Serial  output  driver"); 

return; 
} 


I* EventLoop */ 

void        EventLoop(void) 

{ 

EventRecord        event; 

gDone  =  false; 

while  (gDone  ==  false)  //  loop  here  until  done  with  program 

{ 

if  (WaitNextEvent(everyEvent,  &event,  kSleep,  nil)) 

DoEvent(&event); 
else 

HandleNullO;  //  collect  data  here 

} 
} 
/* */ 
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/* DoEvent 

void        DoEvent(EventRecord  *eventPtr) 

{ 

Boolean  becomingActive; 

char  theChar; 


switch  (eventPtr->what) 

\ 

case  mouseDown: 

HandleMouseDown(eventPtr); 

break; 
case  mouseUp: 

HandleMouseUp(eventPtr); 

break; 
case  keyDown: 

theChar  =  eventPtr->message  &  charCodeMask; 

if((eventPtr->modifiers  &  cmdKey)  !=  0) 

HandleMenuChoice(MenuKey(  theChar)); 

else 

HandleKeyIn(  theChar  ); 

break; 
case  updateEvt: 

DoUpdate(  eventPtr); 

break; 

/» 

case  activateEvt: 

becomingActive  =  ((eventPtr->modifiers  & 

activeFlag)  =: 
activeFlag); 
DoActivate((WindowPtr)eventPtr->message, 
becomingActive); 

} 

break;*/ 

} 

/* 

*/ 

/* 

HandleNull */ 

void 

{ 

HandleNull(void) 

int 

numGPSPoints; 

int 

numDataPoints; 

int 

GPSbuff; 

long 

numCharOut,  numCharln,  numCharlnOld; 

char 

addressBuf[bufferSize] ; 

char 

♦tok; 

char 

*HmeOfRx; 

char 

♦latitude; 

char 

*  longitude; 

char 

♦HDOP; 

char 

*delim="  ,"; 

char 

*end; 
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int 

i; 

unsigned  long  int 

timeVal; 

double 

latVal,longVal,HDOPVal; 

double 

cosfact; 

unsigned  long 

t_mu; 

long 

maxtime; 

Str255 

numstr; 

char 

*lattest="1234.89"; 

double 

lattestd,  dl; 

long 

lattestdec.lattestr; 

double 

timemod; 

if  (gDataScan  == 
{ 

true) 

*/ 


use  this  part  when  the  GPS  receiver  is  available 

numCharOut=5L; 

FSWrite(gASerRefOut,  &numCharOut,  "#GPS  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

maxtime=TickCountO+20L; 

while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCount()  >  maxtime)  break; 

} 
FSRead(gASerRefIn,&numCharIn,&addressBuf)", 

numCharOut=2L; 

FSWrite(gASerRefOut,  &numCharOut,  "?L"); 

SerGetBuf(gASerRefIn,&numCharIn); 

maxtime=TickCountO+20L; 

while(numCharIn  <  55L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO  >  maxtime)  break; 

} 
FSRead(gASerRefIn,&numCharIn,&gGPSBuffer); 


numCharOut=5L; 

FSWrite(gASerRefOut,  &numCharOut,  "#PTR  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

maxtime=TickCountO+20L; 

while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 

if(TickCountO  >  maxtime)  break; 
} 
FSRead(gASerRefIn,&numCharIn,&addressBuO; 

numDataPoints=TalkSail('-'); 
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if(numDataPoints  >  5) 

{ 

gPulseCounter++; 

tok=strtok(gGPSBuffer,delim); 

timeOfi*x=strtok(NULL,delim); 

latitude=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

longitude=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

HDOP=strtok(NULL,delim); 

timeVal=strtoul(timeOfRx,&end,10); 
latVal=strtod(latitude,&end); 
longVal=strtod(longitude,&end); 
HDOPVal=strtod(HDOP,&end); 

if  (HDOPVal  <  10.0) 

{ 

if  (gstarter  ==  true) 

{ 


t_mu=HandleDataIn(numDataPoints); 

gtime2=DecTimeToSec(timeVal); 

gX2=0.0; 

gY2=0.0; 

if  (greflag  ==  true) 

{ 

gYref=LatToY(latVal); 

gYFact=cos((gYref/(1853.2*60.0))*kpi/180.0); 
gXref=LongToX(longVal,gYFact); 
greflag=false; 

} 
gstarter=false; 

} 
else 

{ 

t_mu=HandleDataIn(numDataPoints); 
->  use  this  if  GPS  availble  to  see  if  fixes  are  2  sec  apart 

if(DecTimeToSec(timeVal)  !=  gtime2-2UL) 

if(DecTimeToSec(timeVal)  !=  gtime2) 

{ 

gstarter=true; 

} 
else 

{ 

gtimel=gtime2; 
gtime2=DecTimeToSec(timeVal); 
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// — >  make  up  data  to  test  program 


// — >  end  of  simulated  data 
/*— >use  this  if  GPS  available 


gXl=gX2; 

gX2=LongToX(longVal,gYFact)-gXref; 
gYl=gY2; 
gY2=LatToY(latVal)-gYref; 


gw[gi]=gxold+cos(0.00515*gj)*5. 14778; 
gw[gi+l]=gyold+sin(0.00515*gj)*5. 14778; 

gxold=gw[gi]; 

gyold=gw[gi+l]; 

gj=gj+1.0; 

d  1  =sqrt((gxold- 1 000)*(gxold- 1 000) 

+(gyold-2000)*(gyold-2000)+3000*3000); 
timemod=dl/1.5; 
while(timemod  >  2000.0) 

timemod=timemod-2000.0; 
gw[gi+2]=timemod; 


gw[gi]=(  1 .0-t_mu/((gtime2-gtime  1  )*  1 000.0)*gX  1 

+gX2; 
gw[gi+l  ]=(  1 .0-t_mu/((gtime2-gtime  1  )*  1 000.0)*g  Y 1 

+gY2; 
gw[gi+2]=t_mu; 


gi=gi+3L; 

if(gi  >=  3L*(kStep*kNumExp+lL)  ) 

trackerStart=true; 
if(gi  >=  3L*kStep*(kNumExp+lL)  ) 

{ 

gi=0L; 

gDataWrap=true; 
} 

if((tracker Start  ==  true)  ||  (gDataWrap  ==  true)) 

{ 

tracker(gnumExp); 


> 


} 
else 

{ 


t_mu=HandleDataIn(numDataPoints); 
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gstarter=true; 


} 


I* DecTimeToSec */ 

unsigned  long       DecTimeToSec(unsigned  long  timeVal) 

{ 

unsigned  long      hr,  min,  sec,  timeSec; 

hr=timeVal/10000UL; 
min=(timeVal-hr*10000UL)/100UL; 
sec=timeVal-hr*  lOOOOUL-min*  100UL; 


timeSec=hr*3600UL+min*60UL+sec; 
return(timeSec); 


/* LongToX */ 

double  LongToX(  double  longVal,  double  cosfactor) 

{ 

long  double  deg,  min,  X; 

deg=floor(longVal/100.0); 
min=(longVal-deg*  100.0); 

X=(deg*60.0+min)*1853.2*cosfactor; 

return(X); 


/* LatToY */ 

double  LatToY(double  latVal) 

{ 

long  double  deg,  min,  Y; 

deg=noor(latVal/100.0); 
min=(latVal-deg*  100.0); 

Y=(deg*60.0+min)*  1853.2; 

return(Y); 
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/*- - HandleMouseDown ■ 

void        HandleMouseDown(EventRecord  *eventPtr) 
{ 


} 
/*- 


} 
/*- 


WindowPtr 

whichWindow; 

GrafPtr 

oldPort; 

short 

thePart; 

long 

menuChoice; 

thePart  =  FindWindow(eventPtr->vvhere,  &vvhichWindow); 

switch(thePart) 

{ 

case  inMenuBar: 

menuChoice  =  MenuSelect(  eventPtr->vvhere  ); 

HandleMenuChoice(  menuChoice  ); 

break; 
case  inSysWindow: 

SystemClick(eventPtr,  whichWindow); 

break; 
case  inContent: 

SetPort(whichWindow); 

GlobalToLocal(  &eventPtr->where); 

break; 
case  inDrag: 

DragWindow(which Window,  eventPtr->where, 
&screenBits. bounds); 

break; 
case  inGoAway: 

gDone  =  true; 

break; 


/* HandleMouseUp 

void        HandleMouseUp(EventRecord  *eventPtr) 
{ 


//  Put  some  function  in  here 


/* HandleMenuChoice */ 

void        HandleMenuChoice(long  menuChoice) 

{ 

short  menu; 
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} 

/*- 


} 

/*- 


short  item; 

if  (menuChoice  !=  0) 

{ 

menu=HiWord(rnenuChoice); 
item=LoWord(menuChoice); 

switch(menu) 

{ 

case  mApple: 

HandleAppleChoice(item); 

break; 
case  mFile: 

HandleFileChoice(item); 

break; 
case  mAttenuator: 

Handle  Attenuator(item); 

break; 
case  mBaud: 

HandleBaud(item); 

break; 
case  mSignal: 

HandleSignal(item); 

break; 
} 

HiliteMenu(O); 


/* Handle  AppleChoice 

void        HandleAppleChoice(  short  item  ) 

{ 

MenuHandle  appleMenu; 

Str255  accName; 

short  accNumber; 

switch(item) 
{ 


case  iAbout: 

NoteAlert(kBaseResID,nil); 

break; 
default: 

appleMenu  =  GetMHandle(mApple); 

GetItem(appleMenu,  item,accName); 

accNumber=OpenDeskAcc(accName); 

break; 
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I* - - HandleFileChoice */ 

void        HandleFileChoice(short  item) 

{ 

switch(item) 

{ 

case  iQuit: 

gDone  =  true; 
break; 
} 
} 
/* */ 


/* HandleAttenuator */ 

void        HandIeAttenuator(short  item) 

{ 

MenuHandle  menuHandle; 

long  numCharOut,  numCharln; 

char  attenBuff[10],  addressBuf[10]; 

numCharOut=5L; 

FSWrite(gASerRefOut,  &numCharOut,  "#PTR  "); 

SerGetBuf(gASerRefln,&numCharIn); 

\vhile(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 

} 
FSRead(gASerRefIn,&numCharIn,&addressBuf); 

numCharOut=2L; 

numCharIn=6L; 

menuHandle=GetMHandle(mAttenuator); 

CheckItem(menuHandle,gLastAttn,false); 

CheckItem(menuHandle,item,true); 

gLastAttn=item; 

svvitch(item) 

{ 

case  iAuto: 

FSWrite(gASerRefOut,  &numCharOut,  "AA"); 

break; 
case  iOdB: 

FSWrite(gASerRefOut,  &numCharOut,  "AO"); 

break; 
case  i3dB: 

FSWrite(gASerRefOut,  &numCharOut,  "Al"); 

break; 
case  i9dB: 

FSWrite(gASerRefOut,  &numCharOut,  "A2"); 

break; 
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case  il2dB: 

FSWrite(gASerRefOut,  &numCharOut,  "A3"); 

break; 
case  il8dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A4"); 

break; 
case  i24dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A5"); 

break; 
case  i30dB: 

FSWrite(gASerRefOut,  AnumCharOut,  "A6"); 

break; 

} 

FSRead(gASerRefIn,  &numCharIn,  attenBufO; 
} 
/* */ 


/* HandleBaud */ 

void        HandleBaud(short  item) 

{ 

MenuHandle  menuHandle; 

long  numCharOut,  numCharOutr,  numCharln; 

int  serConfig; 

OSErr  resetErrln,  resetErrOut; 

char  inBuff[8]; 

SerStaRec  serialStatusOut; 

numCharOut=8L; 
menuHandle=GetMHandle(mBaud); 

CheckItem(menuHandle,gLastBaud,false); 

CheckItem(menuHandle,item,true); 

gLastBaud=item; 

switch(item) 

{ 

case  i300: 

FSWrite(gASerRefOut,  AnumCharOut,  "#0000300"); 

gserConfig=baud300+data8+stopl0+noParity; 

break; 
case  i600: 

FSWrite(gASerRefOut,  AnumCharOut,  "#0000600"); 

gserConfig=baud600+data8+stoplO+noParity; 

break; 
case  i 1200: 

FSWrite(gASerRefOut,  AnumCharOut,  "#0001200"); 

gserConfig=baudl200+data8+stoplO+noParity; 

break; 
case  i2400: 

FSWrite(gASerRefOut,  &numCharOut,  "#0002400"); 

gserConfig=baud2400+data8+stopl0+noParity; 
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break; 
case  i4800: 

FSWrite(gASerRefOut,  &numCharOut,  "#0004800"); 
gserConfig=baud4800+data8+stoplO+noParity; 
break; 
case  i9600: 

FSWrite(gASerRefOut,  &numCharOut,  "#0009600"); 
gserConfig=baud9600+data8+stop  1 0+noParity ; 
break; 
} 

SerStatus(gASerRefOut,&serialStatusOut); 

while  ((serialStatusOut.rdPend  !=  0)  ||  (serialStatusOut.wrPend  !=0)) 

{ 

SerStatus(gASerRefOut,&serialStatusOut); 

} 

FSRead(gASerRefIn,  &numCharOut,  &inBuff); 

resetErrOut=SerReset(gASerRefOut,gserConfig); 

resetErrIn=SerReset(gASerRefIn,gserConfig);  //  Set  the  protocal 

if  ((resetErrln  !=  noErr)  ||  (resetErrOut  !=  noErr)) 

{ 

SysBeep(lO); 
ScrollDisplayO; 

DrawString("\pProblem  setting  the  serial  protocal."); 
} 
} 
/* */ 


/* - HandleSignal */ 

void        HandleSignal(short  item) 

{ 

Str255  periodData="\p!M52  "; 

Str255  numMaxData="\p!M63  "; 

Str255  windowData="\p!M74  "; 

char  hexChar; 

long  numCharOut,  numCharln; 

char  inbuff[30],  outbuff[20],  addressBuf[10]; 

int  cr[l]  ={13}; 

int  radix,  hexDec; 

short  i; 

int  period,  numMax,  window; 

SerStaRec  serialStatusOut; 

numCharOut=5L; 

FSWrite(gASerRefOut,  &numCharOut,  "#PTR  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
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} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

switch(item) 

{ 

case  iPeriod: 

gPeriod=HandleDialog(kPeriodDialog); 

period=gPeriod; 

for  (i=0;i  <  kl6Bit;  i++) 

{ 

radix=Power(kHexBase,kl6Bit-l-i); 
hexDec=period/radix; 
hexChar=DecIntToHexChar(hexDec); 
periodData[  1  +i+periodData[0]]=hexChar; 
period=period-hexDec*radix; 

} 

periodData[periodData[0]+kl6Bit+l]=cr[0]; 

periodData[0]=periodData[0]+kl6Bit+l; 

for  (i=0;i<periodData[0];i++) 

{ 

outbuff[i]=periodData[i+l]; 

} 

numCharOut=periodData[0] ; 
break; 
case  iNumMax: 

gNumMax=HandleDialog(kNumMaxDialog); 

numMax=gNumMax*2; 

for  (i=0;i  <  k8Bit;  i++) 

{ 

radix=Po\ver(kHexBase,k8Bit-l-i); 

hexDec=numMax/radix; 

hexChar=DecIntToHexChar(hexDec); 

numMaxData[l+i+numMaxData[0]]=hexChar; 

numMax=numMax-hexDec*radix; 

} 

numMaxData[numMaxData[0]+k8Bit+l]=cr[0]; 

numMaxData[0]=numMaxData[0]+k8Bit+l; 

for  (i=0;i<numMaxData[0];i++) 

{ 

outbuff[i]=numMaxData[i+l]; 

} 

numCharOut=numMaxData[0]; 
break; 
case  i Window: 

gWindo\v=HandleDialog(kWindowDialog); 

window=gWindow; 

for  (i=0;i  <  kl6Bit;  i++) 

{ 

radix=Power(kHexBase,kl6Bit-l-i); 
hexDec=window/radix; 
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hexChar=Dec!ntToHexChar(hexDec); 

windo\vData[l+i+numMaxData[0]]=hexChar; 

window=window-hexDec*radix; 
} 

windo\vData[windowData[0]+kl6Bit+l]=cr[0]; 
windowData[0]=vvindowData[0]+kl6Bit+l; 

for  (i=0;i<windowData[0];i++) 

{ 

outbuff[i]=windowData[i+l]; 

} 

numCharOut=windowData[0]; 

break; 

} 
FSWrite(gASerRefOut,&numCharOut,&outbuff); 

while(l  ==  1) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
FSRead(gASerRefIn,  &numCharIn,  &inbuff); 

if(inbuff[numCharIn-lL]  ==  03)  break; 
} 


} 
/*- 


/* DecIntToHexChar 

int  DecIntToHexChar(int  decimal) 

{ 

int  hexChar; 

if  ((decimal  >=  0)  &  (decimal  <  10)) 
hexChar=48+decimal; 

if  ((decimal  >=  10)  &  (decimal  <  16)) 
hexChar=55+decimal; 

return  (hexChar); 

} 

/* 


/* ConcatString 

void        ConcatString(Str255  strl,  Str255  str2) 

{ 

short       i; 

for(i=strl[0];i<str2[0]+strl[0];i++) 

{ 

strl[i+l]=str2[i-strl[0]+l]; 
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} 

strl[0]=i; 

} 

/* 


/* — -HandleDialog 

unsigned  long 

{ 

WindowPtr 

HandleDialog(int  dialogRes) 

window; 

DialogPtr 

dialog; 

Boolean 

dialogDone; 

Handle 

textltemHandle; 

Handle 

okltemHandle; 

short 

itemType,  itemHit; 

Rect 

itemRect; 

long 

itemNum; 

*/ 


unsigned  long      itemNumU; 

window=FrontWindow(); 

dialog=GetNewDialog(dialogRes,nil,kMoveToFront); 

ShowWindow(dialog); 

SetPort(dialog); 

SetDialogDefaultItem(dialog,  ok); 

SetDialogCancelItem(dialog,  cancel); 

SetDialogTracksCursor(dialog,  true); 


GetDItem(dialog,  iMessageText,  &itemType, 

&textItemHandle,  &itemRect); 

GetDItem(dialog,  ok,  &itemType,  &okItemHandle, 

&itemRect); 

SelIText(dialog,  iMessageText,  kMinTextPosition,  kMaxTextPosition); 

dialogDone=false; 
while(  !  dialogDone) 

{ 

GetIText(textItemHandle,  &gItemText); 
ModalDialog(nil,  &itemHit); 

switch(itemHit) 

{ 

case  ok: 
case  cancel: 

dialogDone=true; 
break; 
} 
} 

DisposeDialog(dialog); 
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Select  Window(window); 
SetPort(window); 

StringToNum(gItemText,  &itemNum); 

itemNumU=itemNum; 

return(itemNumU); 


/♦ — 
void 

{ 


HandleKeyln 

HandleKeyIn(char  theChar) 

int  bufferLength,  i; 

RgnHandle  gtempRgn; 

long  numCharOut,  numCharln; 

char  addressBuf[10]; 


gtempRgn  =  NewRgnQ; 


switch(theChar) 

{ 

case  W: 


case  'K': 


gDataScan=false; 

SelectWindow(gTerrninalWind); 

SetPort(gTerminalWind); 

DravvString("\pW"); 

ScrollDisplayO; 

DrawString("\p:"); 

break; 

gDataScan=false; 

SelectWindow(gTerminalWind); 

SetPort(gTerminalWind); 

numCharOut=5L; 

FSWrite(gASerRefOut,  AnumCharOut,  "#PTR  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

while(numCharIn  <  9L) 

{ 

SerGetBufCgASerRefln.&numCharln); 

} 
FSRead(gASerRefIn,&numCharIn,&addressBuO; 


case  - 


bufferLength=TalkSail('P'); 
Display  String(bufferLength); 
gi=0L; 
break; 

gDataScan=true; 

SelectWindow(gWetPaperWind); 

SetPort(gWetPaperWind); 
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for  (i=0;i  <  10;i++) 

{ 

ScrollDataScanQ; 

} 

numCharOut=5L; 

FSWrite(gASerRefOut,  &numCharOut,  "#PTR  "); 

SerGetBuf(gASerRefIn,&numCharIn); 

while(numCharIn  <  9L) 

{ 

SerGetBuf(gASerRefln,&numCharIn); 

} 
FSRead(gASerRefIn,&numCharIn,&addressBuf); 

bufferLength=TalkSail('0'); 
bufferLength=TalkSail(theChar); 
break; 
default: 

SelectWindow(gTerminalWind); 
SetPort(gTerminalWind); 
bufferLength=TalkSail(theChar); 
Display  String(bufferLength); 
break; 


} 

/*■ 


I* - — --HandleDataln - -*/ 

unsigned  long  HandleDataIn(int  numDataPoints) 

{ 

int  i,j; 

char  max[8][4],  time[8][4]; 

unsigned  timelnt[8],  maxlnt[8]; 

unsigned  long  timeLong; 

Str255  timeOfMaxString; 

unsigned  long  drawTime,  dtemp,  horizontalPosit; 

float  fraction; 

Str255  numpixel,horstring; 

for  (j=0;j<gNumMax;j++) 

{ 

for  (i=0;i<4;i++) 

{ 

max[j][i]=gDataBuffer[8*j+4-i]; 
time[i][i]=gDataBuffer[8*j+8-i]; 

} 

timelnt[j]=0; 
maxlnt[j]=0; 
for(i=0;i<4;i++) 

{ 
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timeInt[j]=timeInt[j]+HexCharToInt(time[j][i],i); 
maxInt[j]=rnaxInt[j]+HexCharToInt(max[j][i],i); 


} 


for  (i=0;i  <  gNumMax;  i++) 

{ 

drawTime=(timeInt[i]*(ghorizontalPixeIs-8UL))/gPeriod; 

SetPort(gWetPaperWind); 
horizontalPosit=drawTime-l-kLeftMargin; 
PenNormal(); 

MoveTo(horizontalPosit,gDataRowStart); 
Line(0,0); 
} 

ScrollDataScanO; 

timeLong=timeInt[0] ; 
retum(timeLong); 

} 

/* */ 


I* HexCharToInt •/ 

unsigned  HexCharToInt(char  Bitejnt  exponent) 

{ 

unsigned  value; 


if  ((Bite  >  47)  &  (Bite  <  58)) 

value=(Bite-48)*Power(kHexBase,exponent); 
if  ((Bite  >  64)  &  (Bite  <  71)) 

value=(Bite-55)*Po\ver(kHexBase,exponent); 


return(value); 


} 


/* — TalkSail */ 

int  TalkSail(char  theChar) 

{ 

long  numCharOut,  numCharln,  startTime.maxTime; 

OSErr  serOutErr,  serlnErr; 

char  inBuff[bufferSize],DataBuffer[bufferSize],inChar; 

int  i,  start; 

SerStaRec  serialStatusIn,  serialStatusOut; 

Str255  startString; 

numCharOut=  1 L; 
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serOutErr=FSWrite(gASerRefOut,  AnumCharOut,  &theChar); 
if  (serOutErr  !=  noErr) 

{ 

SysBeep(lO); 

DrawString("\pProbIem  sending  the  character  out."); 

ScrollDisplayO; 

DrawString("\p:"); 

} 

SerStatus(gASerRefOut,&serialStatusOut); 

while  ((serialStatusOut.rdPend  !=  0)  ||  (serialStatusOut.wrPend  !=0)) 

{ 

SerStatus(gASerRefOut,&serialStatusOut); 

} 

SerStatus(gASerRefIn,&serialStatusIn); 
while(serialStatusIn.rdPend  !=  0) 

SerStatus(gASerRefIn,&serialStatusIn); 

start=0; 

startTime=TickCountO; 
maxTime=startTime+20L; 
while(l  ==  1) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
serInErr=FSRead(gASerRefIn,  &numCharIn,  &inBuff); 
if  (serlnErr  !=  noErr) 

{ 

SysBeep(lO); 

Dra\vString("\pProblem  receiving  characters."); 

ScrollDisplayO; 

DrawString("\p:"); 

} 

memmove(&gDataBuffer[start],&inBuff,numCharIn); 
start=start+LoWord(numCharIn); 

if(inBuff[numCharIn-lL]  ==  03)  break; 

if((start  <  2)  &  (TickCountO  >  maxTime))  break; 

} 
return(start); 

} 

/* */ 


/* Display  String */ 

void  DisplayString(int  numDataPoints) 


{ 


int  i; 

for  (i=0;i  <  numDataPoints  ;i++) 
{ 
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switch(gDataBuffer[i]) 

{ 

case  03: 

break; 
case  13: 

{ 


if  (gDataBuffer[i+l]  ==  10) 

{ 

ScrollDisplayO; 
i=i+l; 

} 
break; 

} 
case  10: 

{ 

if  (gDataBuffer[i+l]  ==  13) 

{ 

ScrollDisplayO; 
i=i+l; 

} 
break; 

} 
default: 

DrawChar(gDataBuffer[i]); 


} 

/* */ 


/* ScrollDisplay 

void        ScrollDisplay(void) 

{ 

RgnHandle  tempRgn; 

WindowPtr  window; 

window  =  FrontWindowQ; 
tempRgn  =  NewRgnO; 

ScrollRect(&window->portRect,  kHorizontalOffset, 

-kRowHeight,  tempRgn); 
DisposeRgn(tempRgn); 

MoveTo(kLeftMargin,  gRowStart); 

} 

/* * 


/* ScrollDataScan- 

void        ScrollDataScan(void) 

{ 

RgnHandle  tempRgn; 
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WindowPtr  window; 

window  =  FrontWindow(); 

tempRgn  =  NewRgnO; 

ScrollRect(&window->portRect,  kHorizontalOffset, 

-kDataScanHeight,  tempRgn); 
DisposeRgn(tempRgn); 

MoveTo(kLeftMargin,  gDataRowStart); 


} 
/*- 


/* DoUpdate •/ 

void        DoUpdate(EventRecord  *eventPtr) 

{ 

WindowPtr  window; 

window  =  (WindowPtr)eventPtr->message; 

BeginUpdate(window); 

//  put  some  update  info  in  here 

EndUpdate(window); 


/*-- Power ■ 

int  Power(int  base,  int  exponent) 

{ 

int  i,  p; 

p=i; 

for  (i=l;i  <=  exponent;++i) 

p=p*base; 
return(p); 

} 

/* 


void  tracker(long          numExp) 

{ 

int  i,  j; 

int  nextlteration,  noUpdate=0,  numlterations=0; 

long  u,  index  1,  index2; 

double  f,  Cs=1.5; 

double  theta[kParameters]={0.0,1000.0,-2500}; 

double  xvar,  yvar,  tvar,  VfkNumMeas]; 

double  term; 

double  stopval=1.0,  epsilon=0.1,  epsilonc; 
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double  D[kParameters][kParameters]; 

double  Dinv[kParameters][kParameters]; 

double  dtheta[kParameters]={0.0,0.0,0.0}; 

double  dthetaSum[kParameters]={0.0,0.0,0.0}; 

double  Z0=0.0,  Zl; 

double  dl_x,  dl_y,  d_z,  dl; 

double  d2_x,  d2_y,  d2; 

double  g[kNumExp+l],  gl[kNumExp+l], 

double  dthetaVec; 

double  xl,  x2,  yl,  y2; 

double  lamdal,  lamda2; 

double  feasl,  feas2,  feas3,  rhomax; 

Boolean  nextlter=true; 

double  *e,  *a,  *b,  *c,  *lamda; 

double  *wtrue; 

double  *dwtrue; 

double  *wmeas; 

Str255  numstr,  thetaString; 

long  thestring; 

double  maxR=5000.0,  maxD=-5000.0,  minD=-1.0; 

wtrue  =  calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(wtrue  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 

abortO; 
} 

wmeas  =  calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(vvmeas  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 
} 

dwtrue  =  calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(d\vtrue  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

e  =  calloc(kNumExp*kNumMeas,sizeof(double)); 
if  (e  ==  NULL) 

{ 

Dra\vString("\pCan't  allocate  memory  for  data  collection!!!"); 

abortO; 

} 

a  =  calloc(kNumExp*kNumMeas,sizeof(double)); 

if  (a  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
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abortO; 
} 

b  =  calloc(kNumExp*kParameters,si7.eof(double)); 
if  (b  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

c  =  calloc(kNumExp,sizeof(double)); 

if  (c  ==  NULL) 

{ 

Dra\vString("\pCan't  allocate  memory  for  data  collection!!!"); 
abortO; 

} 

lamda  =  calloc(kNumExp,sizeof(double)); 

if  (lamda  ==  NULL) 

{ 

DrawString("\pCan't  allocate  memory  for  data  collection!!!"); 

abortO; 
} 

f=1.0/sqrt(2.0); 

for(u=0;u<kNumExp;u++) 

{ 

index  1  =3  *(u*kStep+numExp); 
if(indexl  >=  3*kStep*(kNumExp+l)) 

indexl=indexl-3*kStep*(kNumExp+l); 

index2=3*((u+kNumExp/2)*kStep+numExp); 
if(index2  >=  3*kStep*(kNumExp+l)) 

index2=index2-3*kStep*(kNumExp+l); 

for(i=0;i<3;i++) 

{ 

wtrue[kNumMeas*u+i]=gw[indexl+i]; 

wtrue[kNumMeas*u+i+3]=gw[index2+i]; 

wmeas[kNumMeas*u+i]=gw[indexl+i]; 

wmeas[kNumMeas*u+i+3]=gw[index2+i], 
} 
} 

while(stopval  >  epsilon) 

{ 

numIterations++; 
for(i=0;i<kParameters;i++) 

{ 

dthetaSum[i]=0.0; 

for  (j=0;j<3;j++) 

D[i]U]=0.0; 

} 
Z0=0.0; 
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for(u=0;u<kNumExp;u++) 

{ 

for(i=0;i<kNumMeas;i++) 

{ 

e[6*u+i]=wtrue[6*u+i]-wmeas[6*u+i]; 

} 

dl_x=(wtrue[6*u]-theta[0])*(wtrue[6*u]-theta[0]); 
dl_y=(wtrue[6*u+l]-theta[l])*(wtrue[6*u+l]-theta[l]); 
d_z=theta[2]*theta[2]; 
d  1  =sqrt(d  1  _x+d  1  _y +d_z); 

d2_x=(wtrue[6*u+3]-theta[0])*(wtrue[6*u+3]-theta[0]); 
d2_y=(wtrue[6*u+4]-theta[  1  ])*(wtrue[6*u+4]-theta[  1  ]); 
d2=sqrt(d2_x+d2_y+d_z); 

g[u]=dl-d2-Cs*wtrue[6*u+2]+Cs*wtrue[6*u+5]; 

a[6*u+0]=  (wtrue[6*u+0]-theta[0])/dl; 
a[6*u+l]=  (wtrue[6*u+l]-theta[l])/dl; 
a[6*u+2]=  -Cs; 

a[6*u+3]=  -(wtrue[6*u+3]-theta[0])/d2; 
a[6*u+4]=  -(wtrue[6*u+4]-theta[  l  ])/d2; 
a[6*u+5]=  Cs; 


b[3*u+0]=(\vtrue[6*u+3]-theta[0])/d2-(wtrue[6*u+0]-theta[0])/dl; 

b[3*u+l]=(wtrue[6*u+4]-theta[l])/d2-(wtrue[6*u+l]-theta[l])/dl; 

b[3*u+2]=theta[2]/dl-theta[2]/d2; 

for(i=0;i<3;i++) 

if(b[3*u+i]  —  0.0) 

b[3*u+i]=le-6; 

c[u]=0.0; 

for(j=0;j<6;j++) 

term=a[6*u+j]*gV[j]*a[6*u+j]; 
c[u]=c[u]+term; 

for(i=0;i<3;i++) 

{ 

for(j=0;j<3;j++) 

{ 

D[i]U]=D[i][j]+(l/c[u])*(b[3'u+i]*b[3*u+j]); 

} 
} 

dthetaVec=0.0; 
for(i=0;i<6;i++) 

{ 

dthetaVec=dthetaVec+a[6*u+i]*e[6*u+i]; 

} 
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for(i=0;i<3;i++) 

{ 

dthetaSum[i]=dthetaSum[i]+(dthetaVec-g[u])*b[3*u+i]/c[u] 

} 
ZO=ZO+g[u]*g[u]/c[u]; 


} 


xl=D[l][l]-D[0][l]*D[l][0]/D[0][0]; 

x2=D[l][2]-D[0][2]*D[l][0]/D[0][0]; 
yl=D[2][l]-D[0][l]*D[2][0]/D[0][0]; 
y2=D[2][2]-D[0][2]*D[2][0]/D[0][0]; 

Dinv[2][2]=xl/(xl*y2-x2*yl); 

Dinv[  l][2]=-x2/(x  1  *y2-x2*y  1 ); 

Dinv[0][2]=-(D[0][  1  ]*Dinv[  1  ][2]+D[0][2]*Dinv[2][2])/D[0][0]; 

Dinv[2][l]=-yl/(xl*y2-x2*yl); 

Dinv[l][l]=(1.0+x2*yl/(xl*y2-x2*yl))/xl; 

Dinv[0][l]=-(D[0][l]*Dinv[l][l]+D[0][2]*Dinv[2][l])/D[0][0]; 

Dinv[2][0]=(x  1  /(x  1  *y2-x2*y  1  ))* 

(-D[2][0]/D[0][0]+(D[l][0]*yl)/(D[0][0]*xl)); 
Dinv[l][0]=-(D[l][0]/D[0][0]+x2*Dinv[2][0])/xl; 
Dinv[0][0]=(1.0-(D[0][l]*Dinv[l][0]+D[0][2]*Dinv[2][0]))/D[0][0]; 

for(i=0;i<kParameters;i++) 

{ 

dtheta[i]=0.0; 
for(j=0;j<kParameters;j++) 

{ 

dtheta[i]=dtheta[i]+Dinv[i][j]*dthetaSum[j]; 

} 
} 

for(u=0  ;u<kNumEx  p  ;u++) 

{ 

lamda  1=0.0; 
for(i=0;i<3;i++) 

{ 

lamda  l=Iamdal+b[3*u+i]*dtheta[i]; 

} 

lamda2=0.0; 

for(i=0;i<6;i++) 

{ 

Iamda2=lamda2+a[6*u+i]*e[6*u+i]; 

} 

lamda[u]=(lamda  1  -lamda2+g[u])/c[u]; 

for(i=0;i<6;i++) 

{ 
//  term=gV[i]*a[6*u+i]; 
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d\vtrae[6*u+i]=-e[6*u+i]-lamda[u]*gV[i]*a[6*u+i]; 

} 
} 

if(dtheta[0]  >=  0.0) 

feasl=(kMaxR-theta[0])/dtheta[0]; 
if(dtheta[0]  <  0.0) 

feasl=(kMaxR+theta[0])/(-dtheta[0]); 

if(dtheta[l]  >=  0.0) 

feas2=(kMaxR-theta[l])/dtheta[l]; 
if(dtheta[l]  <  0.0) 

feas2=(kMaxR+theta[  1  ])/(-dtheta[  1  ]); 

if(dtheta[2]  >=  0.0) 

feas3=(kMinD-theta[2])/dtheta[2]; 
if(dtheta[2]  <  0.0) 

feas3=(kMaxD-theta[2])/dtheta[2]; 

rhomax=1.0; 
if(feasl  <  rhomax) 

rhomax  =  feasl; 
if(feas2  <  rhomax) 

rhomax  =  feas2; 
if(feas3  <  rhomax) 

rhomax=feas3; 

epsilon=(gtheta[0]+0.001)/le6; 
if(epsilon  <  0) 

epsilon=-epsilon; 
epsilonc=(gtheta[l]+0.001)/le6; 
if(epsilonc  <  0) 

epsilonc=-epsilonc; 
if(epsilonc  <   epsilon) 

epsilon=epsilonc; 
epsilonc=(gtheta[2]+0.001)/le6; 
if(epsilonc  <  0) 

epsilonc—epsilonc; 
if(epsilonc  <    epsilon) 

epsilon=epsilonc; 

nextlteration=0; 
while(nextIteration  ==  0) 

{ 

Z1=0.0; 
for(u=0;u<kNumExp;u++) 

{ 

dl_x=((wtrue[6*u]+rhomax*f*dvvtrue[6*u]) 

-(gtheta[0]+rhomax*f*dtheta[0]))* 
((\vtrue[6*u]+rhomax*f*dwtrue[6*u]) 

-(gtheta[0]+rhomax*f*dtheta[0])); 
dl_y=((wtrue[6*u+l]+rhomax*f*dwtrue[6*u+l]) 
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} 


-(gtheta[  1  ]+rhomax*f*dtheta[  1  ]))* 
((wtrue[6*u+l]+rhomax*f*dwtrue[6*u+l]) 

-(gtheta[l]+rhomax*f*dtheta[l])); 
d_z=(gtheta[2]+rhomax*f*dtheta[2])*(gtheta[2]+rhomax*f*dtheta[2]); 
d  1  =sqrt(d  1  _x+d  1  _y  +d_z); 

d2_x=((wtrue[6*u+3]+rhomax*f*dwtrue[6*u+3]) 

-(gtheta[0]+rhomax*f*dtheta[0]))* 
((wtrue[6*u+3]+rhomax*f*dwtrue[6*u+3]) 
-(gtheta[0]+rhomax*f*dtheta[0])); 
d2_y=((wtrue[6*u+4]+rhomax*f*dwtrue[6*u+4]) 

-(gtheta[  1  ]+rhomax*f*dtheta[  1  ]))* 
((wtrue[6*u+4]+rhomax*f*dwtrue[6*u+4]) 
-(gtheta  [  1  ]  +rhomax  *  f*  dtheta  [  1  ] )) ; 
d2=sqrt(d2_x+d2_y+d_z); 

g[u]=dl-d2 

-Cs*(wtrue[6*u+2]+rhomax*f*dwtrue[6*u+2]) 
+Cs*(wtrue[6*u+5]+rhomax*f*dwtrue[6*u+5]); 

Zl=Zl+gl[u]*gl[u]/c[u]; 

} 

if(noUpdate  >  5)  Z  1=0.0; 
if(Zl  <  Z0) 

{ 

noUpdate=0; 

nextIteration=l; 

for(i=0;i<3;i++) 

{ 

theta[i]=theta[i]+rhomax*f*dtheta[i]; 
gPosition[i]=gPosition[i]+theta[i]; 

} 

for(u=0  ;u<kNumExp;u++) 

{ 

for(i=0;i<6;i++) 

wtrue[6*u+i]=wtrue[6*u+i] 

+rhomax*f*d\vtrue[6*u+i]; 

} 
} 
else 

rhomax=rhomax/2.0; 

noUpdate++; 


MoveTo(50,150); 

thestring=theta[0]; 

NumToString(thestring,&numstr); 

DrawString(numstr); 

DrawString("\p   :    "); 

thestring=theta[l]; 

NumToString(thestring,&numstr); 
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DrawString(numstr); 
DrawString("\p    :    "); 
thestring=theta[2]; 
NumToString(thestring,&numstr); 
DrawString(numstr); 
for(i=0;i<10;i++)  ScrollDataScan(); 

if(numIterations  >  50) 

stopval=0.0; 
else 

{ 

if(dtheta[0]  <  0) 

stopval=-dtheta[0]; 
else 

stopval=dtheta[0]; 
} 
} 

if(numExp  <  (kNumExp+l)*kStep-l) 

gnumExp=gnumExp+lL; 
else 

gnumExp=0L; 


free(wtrue); 

free(wmeas); 

free(dwtrue); 

free(e); 

free(a); 

free(b); 

free(c); 

free(lamda); 
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